KINEMATIC  AND  DYNAMIC  MODELING ,  ANALYSIS 
AND  CONTROL  OF  ROBOTIC  SYSTEMS 
VIA 

GENERALIZED  COORDINATE  TRANSFORMATION 


BY 

ROBERT  ARTHUR  FREEMAN 


A  DISSERTATION  PRESENTED  TO  THE  GRADUATE  SCHOOL 
OF  THE  UNIVERSITY  OF  FLORIDA  IN  PARTIAL 
FULFILLMENT  OF  THE  REQUIREMENTS  FOR  THE  DEGREE 
OF  DOCTOR  OF  PHILOSOPHY 


UNIVERSITY  OF  FLORIDA 
1985 


Copyright  1985 
by 

ROBERT  ARTHUR  FREEMAN 


TO  MY  PARENTS 
Thanks  for  everything 


ACKNOWLEDGMENTS 


The  author  feels  extremely  fortunate  and  privileged  to 
have  had  the  opportunity  to  be  involved  with  the  Center  for 
Intelligent  Machines  and  Robotics  (CIMAR)  at  the  University 
of  Florida,  for  the  education  gained  from  the  faculty 
associated  with  CIMAR  and  for  their  friendship.     It  is  for 
this  opportunity  to  learn  from  (with)  such  a  high  guality 
group  (both  faculty  and  fellow  students)  of  creative  and 
enthusiastic  individuals  that  the  author  is  perhaps  most 
endebted  to  his  mentor  and  committee  chairman,  Dr.  Del 
Tesar.     The  author  is  also  greatly  appreciative  of  the 
guidance  and  support  of  his  chairman  though  out  the  author 1 s 
educational  experience.     The  author  would  particularly  like 
to  express  his  gratitude  and  appreciation  to    Dr.  Joe  Duffy 
for  his  instruction  in  the  area  of  mechanism  geometry  and 
kinematics,  Dr.  Gary  Matthew  (and  Keilah)  for  his  patience 
and  support  in  helping  work  out  numerous  technical  details 
dealing  with  this  and  other  works,  Dr.  Ralph  Self ridge  for 
introducing  the  author  to  the  computer  language  APL  which 
greatly  facilitates  the  analyses  in  this  work,  Dr.  Ed  Kamen 
for  the  author's  initiation  into  the  field  of  modern 
control,  and  Professors  Ken  Hunt  and  Lou  Torfason  for  their 
comments  and  interest  concerning  this  work. 

The  author  would  also  like  to  acknowledge  all  his  fellow 
Cimarians  (or  Cimarities)  for  their  criticisms,  support, 
encouragements,  and,  most  of  all,  their  friendship.  Special 

iv 


thanks  are  extended  to  Harvey  (and  Leslie)  Lipkin,  Mark 
Thomas  and  Fahriborz  Behi.     Finally,  the  author  is 
especially  grateful  to  Becky  Gee  for  her  dedication  and 
persistence  in  typing  this  manuscript. 


v 


TABLE  OF  CONTENTS 


Page 

ACKNOWLEDGMENTS    iv 

ABSTRACT  viii 

CHAPTERS 

I     INTRODUCTION    1 

II     DEVELOPMENT  OF  THE  CONTROLLING  EQUATIONS   ....  12 

Method  of  Kinematic  Influence  Coefficients  ...  13 

Generalized  Kinematics    13 

Kinematics  of  Serial  Manipulators    23 

System  definition  and  notation  ....  24 

First-order  kinematics    30 

Second-order  kinematics    34 

Third-order  kinematics    46 

The  Dynamic  Model   54 

The  Principle  of  Virtual  Work   55 

The  Generalized  Principle  of  D'Alembert  .   .  57 

The  Dynamic  Equations    62 

Dynamics  of  Serial  Manipulators    64 

Applied  loads    65 

Inertial  effects    65 

The  dynamic  equations    77 

The  Linearization  of  the  Dynamic  Model   78 

The  Linearized  Equations  of  Motion     .    .    .  .79 

Actuator  Dynamics    87 

State  Space  Representation    91 

Note   94 

III     TRANSFER  OF  GENERALIZED  COORDINATES    95 

The  Dynamic  Equations    98 

Kinematic    Influence  Coefficients  101 

vi 


CHAPTERS 

III  (Continued) 

Direct  kinematic  transfer  101 

Kinematic  transfer  of  dependent 
parameters  104 

Dynamic  Model  Parameters  106 

The  Linearized  Equations  109 

Kinematics  109 

State  Space  Equations  Ill 

IV     APPLICATION  OF  GENERALIZED  COORDINATE 

TRANSFORMATION  TO  DYNAMIC  MODELING  AND  CONTROL 

—A  UNIFIED  APPROACH  115 

Single  Closed-loop  Mechanisms     .   .  116 

Multi-loop  Parallel  Mechanisms  127 

Redundant  Systems  134 

Overconstrained  Systems  139 

V     CONCLUSIONS  145 

APPENDICES 

A     DEVELOPMENT  AND  DEFINITION  OF  GENERALIZED 
SCALAR  ( • )   PRODUCT  OPERATOR  FUNDAMENTAL 
TO  DYNAMIC  MODELING  AND  TRANSFER  OF 

COORDINATES  150 

B     SECOND-ORDER  TRANSFER  FOR  A  SIMPLE 

MANIPULATOR  153 

C     SINGLE-LOOP  PLANAR  FIVE-BAR  ANALYSIS  159 

D     SPECIAL  CASE  SINGLE-LOOP  MECHANISMS  165 

E     PARALLEL  MECHANISM  MODELING  170 

BIBLIOGRAPHY  176 

BIOGRAPHICAL  SKETCH  181 


vii 


Abstract  of  Dissertation  Presented  to  the 
Graduate  School  of  the  University  of  Florida  in  Partial 
Fulfillment  of  the  Requirements  for  the 
Degree  of  Doctor  of  Philosophy 

KINEMATIC  AND  DYNAMIC  MODELING,  ANALYSIS 
AND  CONTROL  OF  ROBOTIC  SYSTEMS 
VIA 

GENERALIZED  COORDINATE  TRANSFORMATION 

By 

ROBERT  ARTHUR  FREEMAN 
August,  1985 

Chairman:     Delbert  Tesar 

Major  Department:     Mechanical  Engineering 

This  work  presents  a  unified  approach  to  the  dynamic 
modeling  and  analysis  of  the  general  case  of  rigid-link 
multi-degree  of  freedom  mechanical  devices  and  includes  the 
detailed  treatment  of  the  specific  case  of  the  serial 
manipulator.     The  approach  is  based  on  the  transference  of 
the  system  dependence  from  one  set  of  generalized 
coordinates  to  another  (e.g.,  from  the  relative  joint  angles 
to  cartesian  referenced  hand  coordinates  of  the  serial 
manipulator)  and  is  shown  to  allow  the  analysis  of  any 
single-loop  mechanism  (e.g.,  the  Bricard  mechanism), 
multi-loop  parallel-input  linkages,  systems  with  a 
superabundance  kinematically  independent  inputs  (e.g., 
redundant  manipulators),  and  systems  containing  a 
superabundance  of  kinematically  dependent  inputs  (e.g., 
walking  machines).     The  technique  involves  the  initial 
modeling  of  the  system  (or  its  components)  in  terms  of 
simple  open  kinematic  chain  relationships;  then  using  the 
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concept  of  loop  closure  and  the  kinematic  constraints 
relating  the  possible  sets  of  generalized  coordinates  the 
final  desired  system  model  is  obtained. 

The  derivation  of  the  initial  dynamic  model  is  based 
almost  entirely  on  the  principle  of  virtual  work  and  the 
generalized  principle  of  d'Alembert  and  is  treated  in  great 
detail  (from  first-order  properties  through  the  linearized 
state  space  model,  including  actuator  dynamics).  The 
resultant  model  is  expressed  in  terms  of  kinematic  and 
dynamic  influence  coefficients  and  is  particularly  well 
suited  for  the  transfer  of  generalized  coordinates, 
especially  the  quadratic  form  of  the  non-linear  effective 
load  terms.     The  validity  of  the  results  of  the  unified 
modeling  approach  is  demonstrated  by  some  simple  yet 
sufficient  examples. 


CHAPTER  I 


INTRODUCTION 

One  of  the  most  pressing  issues  facing  engineers  today 
is  the  control  of  highly  integrated  mechanical-based  systems 
capable  of  addressing  a  wide  variety  of  tasks,  without 
physical  alteration  of  the  system  itself.     These  integrated 
systems  (commonly  referred  to  as  robotic  devices)  are,  in 
essence,  asked  to  manipulate  an  object  (e.g.,  a  tool 
attached  to  the  end-effector)  in  the  presence  of  varying 
process  and  environmental  effects  in  a  very  precise  manner. 
To  respond  to  this  desire  for  both  diverse  motion  capability 
and  precise  maintenance  (during  operation)  of  the  specified 
motion  reguires  not  simply  a  battery  of  sensors  feeding  back 
infinite  information  to  a  central-processing-unit  which 
magically  assimilates  and  transforms  these  data  into 
appropriate  compensatory  commands  to  the  system  actuators, 
but  an  acute  awareness  of  the  device  itself.     That  is  to 
say,  a  sufficient  mathematical  representation  (model)  of  the 
object  of  control  (the  actuated  mechanical  linkage)  must 
exist.     The  obtainment,  and  subsequent  investigation  of  this 
model  (which  not  only  removes  the  magic  from  the  control 
process,  but  also  indicates    what  feedback  information  is 
necessary  and  sufficient  for  that  process)   is  the  primary 
focus  of  this  work.     While  there  is  argument  that  one  only 
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needs  a  qualitative  model  (e.g.,  knowledge  that  a  particle's 
acceleration  is  linearly  related  to  force)  of  the  system  for 
feed-back  compensation,  there  is  no  question  that  a 
quantitative  model  (e.g.,  a  particle's  acceleration  is  equal 
to  the  force  applied  to  the  particle  divided  by  its  mass)  is 
essential  for  feed-forward  compensation.     Now,  while  the 
author  is  not  familiar  with  all  the  vagarities  of  adaptive 
control,  it  seems  only  reasonable  that  one  would  prefer  to 
accomplish  as  much  feed-forward  compensation  as  possible, 
and  then  use  feed-back  techniques  to  obtain  the  (reduced) 
remaining  required  compensation.     Admittedly,  the 
quantification  of  the  model  (e.g.,  determination  of  the 
particle's  mass)  is  considerably  more  difficult  than  its 
qualification,  but  this  difficulty  is  not  sufficient  reason 
to  dismiss  the  possibility  (and  potential)  of  combined 
feed-forward,  feed-back  control  schemes  for  robotic  devices. 
Keeping  the  goal  of  this  combined  control  in  mind,  the 
kinematic  and  dynamic  models  developed  in  this  work  are 
derived  in  a  qualitative  manner  while  the  final  expressions 
require  the  quantification  of  basic  system  properties,  such 
as  link  dimensions  and  mass  parameters. 

The  formalized  modeling  procedure  presented  establishes 
a  base  technology  capable  of  addressing  the  full  range  of 
possible  mechanisms,  from  a  single  generic  approach.  The 
procedure  stems  from  the  work  of  Tesar  and  his  graduate 
students,  most  notably  the  general  development  of  Benedict 
and  Tesar  (1971)  and  the  rigid-link  serial  manipulator  model 
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of  Thomas  (1981).     The  model  is  based  on  the  use  of 
kinematic  influence  coefficients.     These  coefficients 
describe  the  position-dependent  reaction  of  such  pertinent 
systems  parameters  as  link  centroids  to  the  action  of  the 
independent  generalized  coordinates  (system  inputs).  While 
the  basic  model  is  a  rigid-link  model,  and  robotic  devices 
typically  demonstrate  some  compliance  (Sunada  and  Dubowsky, 
1983),  the  model  is  presently  being  used  as  the  basis  for 
extension  to  the  treatment  of  guasi-static  deformations 
(Fresonke,  1985)  and  guasi-statically  induced  vibrations 
(Behi,  1985),  for  optimized  design  procedures  (Thomas,  1984 
and  1985),  and  as  an  aid  in  the  experimental  identification 
of  pertinent  system  parameters. 

The  extension  to  nonrigid-link  devices  is  not 
specifically  addressed  here,  nor  is  the  guestion  of 
real-time  dynamic  compensation  (see  Wander,  1985).  Again, 
the  primary  objective  of  this  work  is  the  development  of  a 
general,  unified  modeling  procedure  capable  of  addressing 
the  full  range  of  robotic  devices,  including  redundant 
manipulators,  cooperating  robots,  walking  machines  and 
multi-fingered  end-effectors.     For  discussion  and  comparison 
of  the  various  popular  dynamic  model  formulations,  the 
reader  is  referred  to  Tesar  and  Thomas  (1979)  and  Thomas  and 
Thomas  (1982b),  Silver  (1982)  and  Lee  (1982),  among  others. 

Before  giving  a  more  detailed  overview  of  the  contents 
of  this  work,  it  will  prove  beneficial  to  introduce  the 
notational  scheme  developed  herein.     Referring  (throughout) 
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to  Table  1-1,  the  basic  setui   involves  a  block  arrangement 
consisting  of  a  central  bloc]    surrounded  by  both  pre-  and 
post-,  superscripts  and  subscripts.     The  center  block  is 
reserved  for  a  symbol  represt  nting  either  a  system 
parameter(s)   (e.g.,  the  set  ;u)),  a  physical  quantity  (e.g., 
a  vector  of  applied  loads  (T  )  or  a  mathematical  operator  or 
operation  (e.g.,  partial  dif  nerentiation)  .     Next,  the  two 
superscript  blocks  are  reser1  ed  for  dependent  system 
parameters  (or  their  properties,  such  as  velocity),  with  the 
post-script  indicating  which  parameter(s)  is  involved  and 
with  the  pre-script  giving  ac  ditional  information  concerning 
the  parameter ( s) .     Finally,  *  he  two  subscript  blocks  are 
used  in  exactly  the  same  fasl.ion  as  the  superscripts,  but 
are  reserved  for  independent  system  parameters  (e.g., 
generalized  coordinates  (c£)  or  fixed  linkage  dimensions 
(a-j^)).     At  this  stage  the  re  ader  is  again  referred  to  Table 
1.1  to  review  the  illustrate  e  examples.     While  this 
notation  is  indeed  redundant  when  dealing  with  a  single 
(fixed)  set  of  independent  g<  neralized  coordinates,  it  is 
far  from  redundant  when  deal.\ng  with  the  analytic 
developments  and  application:    in  Chapters  III  and  IV  where 
the  system  dependence  is  transferred  from  one  possible 
generalized  coordinate  set  t<    another.     Regardless,  it  is 
felt  that  even  when  dealing  '  1th  a  fixed  input  set,  that  the 
separation  of  dependent  and  .  ndependent  system  parameters  by 
the  respective  use  of  supersc  ripts  and  subscripts  serves  as 
a  valuable  aid  in  the  descrii  tion  and  analysis  of  the  system 


Table  1-1.  Notation 

Dependent  [Modifier]  [Parameter* s) ]  Dependent 

_  Symbol 
|  —  Operator 


f 


Independent      [Modifier]  [ Parameter ( s ) ]  Independent 


Examples 

T.     u  =  f  (<p)  :  "  "  

,12  RT  [  J  [P] 

u=  (ux,uz, .  .  .  ,u^)  1     -  dependent  [u] 

[  ]       [  ] 

vT  [  J        t  J 

<p  -  (<P]_  ,cp2  , .  • .  cpM )  ^  -  independent  [<p] 

I  ]  [m] 


[  ] 

[  u] 

2.    3(u)   =  ( 

)            =  [Gu]  = 

t  Gu ]   ( Thomas 

amd  Tesar,  1982b) 

Sep  ( 

)  * 

[  ] 

where  G  = 

3(    )       [See  eqn 

s.    (2-5)  and 

(2-6)  ] 

3(  ) 

3.  3  lili  =           3  (    )  =  [Hu  1  =  [Hui  (Thomas  and  Tesar, 
3cp3cp_               3<p3cp  "  1982b) 

[   ]  [epepj 

where  H  =     3 (    )  [See  eqn's.   ( 2-11 )-( 2-27 )  ] 

3(    )3(  ) 

4.  .2{M3k[jGc]T[3Gc]}  =   CP][I*][    1  =    [Pi*  ] 
J"1             «          «  [    ]          [epep  j  W 

M 

where  ?!*  =   .S^^G^  ^TpF^     ]     [See  eqn.  (2-157)] 
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under  investigation.     In  addition  to  being  descriptive  in 
nature,  this  notational  scheme  underscores  the  fundamental 
theme  of  this  work;  that  there  are  only  two  basic  types  of 
system  parameters  (dependent  and  independent),  but  that 
there  is  not  a  unique  set  of  generalized  coordinates  from 
which  to  view  the  system.     The  notational  scheme  also  has 
been  developed  with  the  assimilation  of  ten  plus  years  of 
various  kinematic  and  dynamic  analyses  presented  by  Tesar 
and  his  students  into  a  single  formalized  unit.     As  a  final 
note  to  readers  familar  with  the  notation  utilized  by  Thomas 
and  Tesar  (1982b),  to  obtain  the  parameter  descriptions 
given  in  that  work  simply  drop  all  subscripts  (since  only 
one  set  of  generalized  coordinates  is  addressed)  and  rotate 
the  superscripts  one  block  in  the  clock-wise  direction 
(e.g.,  the  post-superscript  in  this  work  becomes  the 
subscript  in  Thomas  and  Tesar  (1982b)  as  shown  in  examples  2 
and  3  of  Table  1-1) . 

In  keeping  with  the  desire  to  present  as  generic  a 
treatment  as  possible,  Chapter  II  starts  off  with  the 
development  of  the  first-,  second-  and  third-order 
kinematics  of  a  general  multi-degree  of  freedom  system. 
Here,  the  conceptual  use  of  kinematic  influence 
coefficients,  along  with  the  definition  of  the  associated 
notation,  is  introduced.     The  concept  of  influence 
coefficients  is  fundamental  to  the  modeling  methodology 
employed  throughout  this  work  and  the  need  to  understand 
this  basic  idea  cannot  be  overemphasized.     Additionally,  the 
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qualitative  approach  to  deriving  the  high-order  kinematics 
is  stressed,  as  well  as  the  utility  and  simplicity  of  the 
standard  Jacobian  format  for  arranging  the  results  of  vector 
differentiation.     Again,  the  reader's  complete  familiarity 
with  the  method  of  derivation  employed  (and  the  notation 
involved  in  describing  the  results)  in  this  section 
(II.A.l.)  will  greatly  facilitate  his  understanding  of  the 
remainder  of  this  work. 

Next,  the  kinematics  of  the  general  serial  manipulator 
are  addressed.     First,  the  geometric  parameters  and  the 
associated  notation  describing  the  serial  manipulator  are 
defined,  then  the  first-,  second-  and  third-order  kinematics 
are  addressed.     The  derivation  presented  here  is  based  on 
the  previously  developed  generalized  kinematics,  with  the 
major  emphasis  here  being  on  the  determination  of  the 
kinematic  influence  coefficients  for  this  specific  device. 
The  method  of  derivation  and  form  of  the  results  (simple 
vectors  or  vector  cross  products)  are  based  directly  on  the 
work  of  Thomas  (1981). 

Having  completed  the  treatment  of  the  system  kinematics, 
attention  is  then  turned  to  the  development  of  the  dynamic 
model.  The  dynamic  model  presented  here  is  almost  completely 
determined  with  the  use  of  just  two  principles  of  mechanics: 
the  principle  of  virtual  work  and  the  generalized  principle 
of  D'Alembert.     In  light  of  this,  and  in  keeping  with  the 
generic  nature  of  this  work,  the  use  of  these  two  principles 
in  the  development  of  the  dynamic  equations  for  a  general 
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device  is  presented  first.     Here  the  momentum  form  of 
Newton's  second  law  is  used.     After  establishing  the  general 
approach,  the  dynamics  of  the  serial  manipulator  are 
addressed  specifically.     In  this  treatment  (II.B.4.),  the 
results  for  the  manipulator  are  expressed  in  matrix  form, 
this  being  consistent  with  the  method  of  derivation  as  well 
as  with  the  computer  language  (APL)  that  the  author  uses  for 
simulation.     In  fact,  the  author's  familiarity  with  the 
multi-dimensional  array  handling  and  operational 
capabilities  of  this  language  (APL)  is  most  certainly  a 
contributing  factor  in  the  chosen  form  of  the  resultant 
modeling  expressions.     Again,  for  the  investigator  familiar 
with  the  work  of  Thomas  (1981)   (aside  from  the  notation  and 
method  of  derivation)  and  the  expression  of  the  coefficients 
of  the  dynamic  model  in  matrix  (vector)  form  here,  as 
opposed  to  the  summation  (scalar)  form  of  Thomas  (1981),  is 
the  only  difference  in  the  modeling  results  of  the  two 
works.     Also,  and  of  paramount  importance  to  the 
transformation  of  generalized  coordinates  technique 
presented  in  Chapter  III,  a  generalized  vector  scalar 
product  operator  (•)  is  introduced.     Because  of  the 
significance  of  this  operator  to  this  entire  work,  it  is 
addressed  in  detail  in  Appendix  A. 

Next,  for  completeness,  the  linearization  of  the  dynamic 
equations  of  the  general  serial  manipulator  is  pursued.  The 
derivation  of  these  linearized  equations  is  again  attacked 
in  a  qualitative  fashion  (i.e.,  partials  are  taken  with 
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respect  to  the  generalized  coordinate  positions,  velocities 
and  accelerations).  Unfortunately,  the  resultant  expressions 
are  extremely  complicated  and  a  nice  compact  form  was  not 
found.     At  any  race,  having  obtained  expressions  for  the 
linearized  eguations,  the  drive  train  kinematics  and 
actuator  (d-c  motor)  dynamics  are  incorporated  into  the 
model.     The  nominal  voltages  required  to  drive  the  system 
along  some  specified  generalized  coordinate  trajectory  are 
then  determined  and,  finally,  a  velocity-referenced  state 
space  model  of  the  linearized  system  is  developed.  While 
the  resulting  state  space  model  can  be  used  to  address  the 
possibility  of  applying  modern  linear  control  techniques  to 
controller  design  for  specific  manipulator  trajectories 
(Whitehead,  1984),  this  is  not  a  goal  of  this  work  and  is 
not  pursued.     This  completes  the  material  presented  in 
Chapter  II,  covering  the  complete  development  of  the 
kinematic  and  dynamic  equations  governing  the  motion  of  both 
a  general  mechanism  and  the  serial  manipulator  in  terms  of  a 
specific  set  of  generalized  coordinates. 

Having  established  the  general  procedure  for  obtaining 
the  dynamic  model  directly  in  terms  of  a  specific  set  of 
generalized  coordinates,  attention  is  now  turned  to  the 
determination  of  the  model  with  respect  to  any  set  of 
generalized  coordinates.  Chapter  III  specifically  addresses 
this  question,  with  the  basic  approach  employing  a  transfer 
of  system  dependence  from  one  set  of  generalized  coordinates 
to  another.     The  technique  involves  the  determination  of  the 


model  (in  the  direct  fashion  of  Chapter  II)  with  respect  to 
some  initial  set  of  generalized  coordinates  (selected  for 
ease  of  modeling),  then  (using  this  initial  model 
information  along  with  the  principle  of  virtual  work  and  the 
system's  kinematic  constraints)  the  system  model  is 
effectively  transferred  to  any  arbitrary  desired  set  of 
generalized  coordinates.     The  treatment  here  is  basic  in 
nature  and  covers  the  three  main  elements  comprising  the 
system  modeling  of  Chapter  II:  kinematics,  dynamics  and  the 
linearized  state  space  representation.     The  use  of  this 
concept  is  not  without  precedent  as  it  has  been  employed  in 
one  form  or  another  by  numerous  researchers  (referenced  in 
Chapter  III),  primarily  with  regards  to  system  control.  One 
of  the  self-imposed  constraints  on  the  model  transformation 
presented  here  is  that  the  resultant  desired  model  maintain 
the  same  general  form  as  the  initial  model  (e.g.,  eguations 
(2-7),   (2-17)  and  (2-198)).     Also,  as  is  shown  in  Chapter 
III,  the  generalized  scalar  product  (Appendix  A)  is  the  key 
mathematical  realization  allowing  the  maintenance  of  the 
general  form. 

Now,  having  established  the  basic  procedures  for 
obtaining  an  initial  system  model  (Chapter  II)  and  the 
subseguent  determination  of  the  system  model  referenced  to 
any  set  of  generalized  coordinates  (Chapter  III),  the 
full  utility  of  the  generalized  coordinate  transfer 
technique  is  addressed.     Through  the  treatment  of  some 
fairly  general  applications,  Chapter  IV  presents  a  unified 


and  straight-forward  approach  to  the  kinematic  and  dynamic 
modeling  of  a  wide  variety  of  extremely  complicated 
mechanical  systems.     This  unified  approach  first  entails  the 
initial  modeling  of  the  system  (or  separable  components  of 
the  system)  in  the  relatively  simple  terms  of  an  open-loop 
kinematic  chain.     Then,  having  obtained  this  simple  initial 
model,  the  system  is  constrained  (or  closed)  by  single  or 
multiple  application  of  the  transfer  equations  resulting  in 
the  desired  dynamic  model.     This  means  that  the  most 
complicated  kinematic  device  that  one  need  model  directly  is 
the  simplest  possible,  the  open  kinematic  chain  (or  serial 
manipulator).     Finally,  for  illustration  of  the  full  power 
and  scope  of  this  technique  it  is  shown  to  be  capable  of 
modeling 

1.  Any  single-loop  mechanism  (including  such  degenerate 
devices  as  the  Bricard  mechanism)  with  respect  to 
any  set  of  generalized  coordinates. 

2.  Multi-loop  parallel-input  mechanisms,  such  as  the 
generalized  Stewart  platform. 

3 .  Systems  with  a  superabundance  of  kinematically 
independent  inputs ,  such  as  the  redundant 
manipulator . 

4.  Systems  with  a  superabundance  of  kinematically 
dependent  inputs;  such  as  cooperating  robots, 
walking  machines  and  multi-fingered  end-effectors. 


CHAPTER  II 


DEVELOPMENT  OF  THE  CONTROLLING  EQUATIONS 


The  investigation  of  the  basic  kinematic  and  dynamic 
nature  of  multi-degree  of  freedom  mechanisms  and  the 
subsequent  determination  of  a  set  of  differential  equations 
useful  in  addressing  the  control  of  such  mechanisms  are 
presented  in  this  chapter.     The  presentation  is  separated 
into  three  major  divisions.     The  first  section  develops  a 
generalized  approach  to  the  modeling  and  analysis  of  the 
system  kinematics.     The  approach,  which  is  based  on  the  use 
of  kinematic  influence  coefficients,  is  applicable  to 
mechanisms  consisting  of  rigid,  or  at  least  quasi-rigid, 
links.     In  the  second  section,  the  influence  coefficient 
methodology  is  incorporated  in  the  determination  of  the 
dynamic  model,  yielding  the  relationship  between  the 
system's  load  and  motion  states.     Finally,  the  dynamic 
equations  (developed  in  the  second  section)  are  linearized 
and  a  general  state  space  representation  is  presented.  This 
representation,  which  includes  actuator  dynamics,  is  useful 
when  considering  the  control  of  the  mechanism  about  some 
prespecified  nominal  trajectory. 


12 


13 


Method  of  Kinematic 
Influence  Coefficients 

This  approach  to  dynamic  modeling  of  rigid-link 
mechanisms  is  based  on  the  separation  of  all  kinematic  (and 
dynamic)  phenomena  into  a  collection  of  purely  position 
dependent  functions  (kinematic  influence  coefficients) 
operated  on  by  independent  functions  of  time  ( input  time 
states).     The  concept  of  kinematic  influence  coefficients 
can  be  applied  to  all  classes  of  mechanisms  (e.g., 
parallel-input  planar  systems,  serial-input  spatial  devices, 
etc.)  and  has  been  well  established  in  the  literature  by  the 
works  of  Tesar  and  his  graduate  students:  Benedict  and  Tesar 
(1971),   (1978a)  and  (1978b),  Freeman  and  Tesar  (1982)  and 
(1984),  Cox  and  Tesar  (1981),  Thomas  (1981)  and  Sklar  and 
Tesar  (1984).     Because  of  the  fundamental  nature  of  this 
concept  and  its  almost  limitless  range  of  application,  this 
section  is  presented  in  two  parts.     The  first  contains  a 
detailed  development,  in  general  terms,  of  the  basic 
methodology  involved.  The  second  addresses  the  specific  case 
of  the  serial  manipulator. 

Generalized  Kinematics 


Consider  a  P-dimensional  time  varying  vector 
u(t)  =  (u!(t),  up(t))T 


(2-1) 
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representative  of  the  motion  parameters  required  to  describe 
the  kinematics  of  a  given  system  where  the  superscripts 
indicate  which  parameter  is  involved  (not  that  uP  is  u 
raised  to  the  pth  power).  Further,  consider  that  these 
parameters  are  functions  of  an  M-dimensional  set  of 
generalized  coordinates 

cp(t)  =  (cpx(t),  <p2(t),  <PM(t))T  (2-2) 

This  allows  a  parametric  description  of  the  system  where 

UP  =  UP((£)  ;p  =  1,2  P  (2-3) 

and 

cpn  =  (pn(t)  ;n  =  1,2, ...  ,M  (2-4) 
Adopting  the  standard  convention  for  differentiation  of 
a  vector  (e.g.  ,u((g) )  by  a  vector  (e.g.,  cg(t))  one  obtains 
the  typical  Jacobian  form,  where  the  nth  column  of  the 
result  is  the  partial  derivative  of  u(<f>)  with  respect  to  the 
nth  component  of  (f>(t),  for  the  first  time  derivative  of 
u(t))  as 

u  =  [9ujcfr 

=  [9u    iu     . .  .  Su.  ]q> 

d(i>i  3<P2  3<pM  (2-5) 

*1 

<i>M 

Throughout  this  section  an  explicit  shorthand  notation  is 
developed  to  serve  as  a  descriptive  aid  in  the  expression  of 
the  system  kinematics.     The  first  order  geometric 


9U1  3U1 


9uJ 


3<Pl 


3ux 

3(Pjyj 


3<PM 


derivatives  (i.e.,  kinematic  influence  coefficients)  are 
denoted  as  follows: 


=  [Gu] 

3cp 

CP 

[Ju  ] 

=  [GUJ 

9cpn 

cp  ; 

[  9uP] 

=  [Gu  ] 

3<o 

L  9uP] 

=  [Gu] 

3cpn 

^P; 

n  n 

(2-6) 


cp  cp 


n  n 


where  the  letter  (g,G)  is  reserved  for  first  order  geometric 
derivatives,  the  superscript  indicates  the  dependent 
parameter(s)  involved  (i.e.,  uP )  and  the  subscript  specifies 
whicn  generalized  coordinate  ( s )   (i.e.,  <pn)  is  involved. 
Also,  the  snape  of  the  result  is  indicated  by  the  dimensions 
of  symbols  used  as  the  superscript  and  subscript ( s ) .  For 
example,  the  shape  of  2^  is  equal  to  the  dimension  of  the 
subscript  u  (i.e.,  P)  by  the  dimension  of  the  subscript  n 
(i.e.,  1).  Referring  to  equations  (2-6),  the  first  order 
kinematics  of  the  system  can  be  written  in  a  variety  of  ways 
depending  on  the  manner  of  expression  one  wishes  to  employ. 
The  velocity  (u)  of  the  complete  parameter  set  (u)  can  be 
expressed  as 


u  =  [Gu](£  =  (P  x  M)(M  x  1)  =  P  x  1  (2-7) 
_  cp 


or 


M      ,,  . 

u  =    Saucpn  =  s(Pxl)(lxl)=Pxl  vector 
n=l  -n  u 


(2-8) 
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And,  the  velocity  (uP)  of  a  particular  dependent  parameter 
(uP)  is  written  as 

up  =  Sep  2  =  (1  x  M)(M  x  1)  =  1  x  1  (2-9) 


or 


uP  =  E     gP  cpn  =  E(l  x  1)(1  x  i)   =  1  x  1  (2-10) 
n=l  n 

Noting  that  first-order  influence  coefficients  (g,G)  are 
functions  of  the  generalized  coordinates  leg),  one  recognizes 
that  the  velocity  vector  (u)  is  a  function  both  of  the 
position  (eg)  and  velocity  (cp)  of  the  independent  coordinates 

(<pm;  m  =  1,2,  ,M)  .     This  allows  one  to  obtain  the  second 

time  derivative  (u)  of  the  dependent  parameters  (u) 
from 

3cp  3  cp 

The  first  partial  derivative  in  eguation  (2-11)  is 

3i  =  LGVJ   =     3([Gu]cp)   =   [Guj3&  =   [Gu][IjMxM  i2-l2) 

where  the  last  term  is  the  MxM  identity  matrix.     This  gives 
the  partial  acceleration  of  (u)  due  to  the  acceleration  of 
the  inputs  (eg)  as 

y.{p  =  iSJcg  (2_13) 


Recalling  the  standard  Jacobian  form  for  derivatives  of 
vectors,  one  has 
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3u  = 
3cp_ 


=     3([GU](£)  = 
3l 


Su1  Su1 
3cpx  3<p2 

3u2 
3<Pl 

acpi 


3uJ 
3<PM 


3u* 
3<PM 


(2-14) 


where 


M 

gP  =  9uP  =  _3    (   2     gP  cj>n)  ,  p  =  1,2,  .  .  .  ,P 

m      ^m  n"       n  <2"15) 

m  =  1 ,  2  ,  .  .  .  ,M 

Recalling  the  definition  given  in  equation  (2-6)  for  (<?P)/ 
and  performing  the  differentiation,  equation  (2-15)  becomes 

M 

gP  =      a    [_3    (3uP)  ]<j> 

m      n=1  3*m  3^n 

M  (2-16) 

=  hP  cpn 

n=l    mn  LL 

=  1x1 

where 

9       (3uP)   HhP    =  ixlxl  (2-17) 
3(Pm      3<pn  ran 

Alternately,  equation  (2-16)  can  be  expressed  in  vector  form 

as 

gP  =  cpT(hp  }T  =  !  x  i  (2-18) 
m      —  — mcp 

where 


hP    =  (hP  ,  hP  .  hP  )  =  1  x  1  x  M  (2-19) 

"mcp         ml      m2  mM 
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Here,  the  letter  (h,H)  is  used  to  denote  the  second-order 
geometric  derivative,  and  the  shape  of  the  result  is  equal 
to  the  dimension  of  the  superscript  by  the  dimensions  of  the 
subscripts  ordered  from  left  to  right.     Using  the  vector 
form  of  equation  (2-18),  the  pth  row  of  equation  (2-14)  can 
de  written  as 


3g>  P< 


[Guj       =  [GP] 
CP  p;  cp 

=  cp'T[(hP  )   (hP  ) 
-       ~lcp  ~2cp 

=  ^TCHP  ]T 
cpcp 


(hP  )TJ 

-Mcp 


(2-20) 


where 


=  1  x  M 


[HP  J 
cpcp 


9cp  9cp 


hP  hP 
11  12 


hP 
21 


hP 
Ml 


.  hP 
1M 


hP 
MM 


=  1  x  M  x  M 

(2-21) 


From  this,  the  partial  acceleration  of  the  pth  dependent 
parameter  (up)  due  to  the  velocity  of  the  inputs  (cpj   is  seen 
to  be 


UP.  =  cpT[HP  ]T<p  =  1  x  1  x  1 
cpcp  cpcp 


(2-22) 


Since  the  transpose  of  a  scalar  is  equal  to  itself,  equation 
(2-22)  becomes 


UP.     =    (£T[HP  ]C£ 

cpcp  <P<P 


(2-23) 


Now,  considering  the  complete  parameter  set  (u)  ,  one  has 


/^[H1  ]cj>\ 
/  cpcp  \ 


cpT[HP  ]cp/ 
cpcp 


fiT[«!5q,]2  =  P  x  1 


(2-24) 


wnere 


[Hu  ]  =  P  x  M  x  M 
cpcp 


(2-25) 


and 


[Hu   ]         =   [HP  ] 
cpcp  p  ;  ;  cpcp 


(2-26) 


Finally,  from  equations  (2-11),  (2-13)  and  (2-24),  the 
acceleration  (u)  is  found  to  be 


U  =   [Gu]cp  +  cpT[Hu  jcp 
cp  -  cpcp  - 


(2-27) 


Observing  that  the  acceleration  (u)   is  a  function  of 
(cp_)  ,   (cp)  and  (cp)  ,  the  third  order  time  derivative  (u)  can  be 
determined  from 
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Here 


3ji  =  [Gu]9ja  =  [Guj  LI]MxM 
3cp  cp  3(p  cp 


(2-29) 


so 


3ji  2  =  LGU]£ 
3  5£  (£ 


(2-30) 


The  second  term  in  equation  (2-28)  is  found  from 


3ii.. 
3<£  35£ 


3U1  3U1 
cpcp  cpcp 


3<Pl  3cp2 


3u 


2 

jgcb 


3«>1 


3U1 


_(P(£ 


3<J>1 


where,  from  equation  (2-22), 


3ul. 
cpcp 

3  cpM 


3uJ 


cpcp 


3cpM 


(2-31) 


3  UP         6T  hp  Tcb 

cpcp  =  3  (~  [  cpcp]  ~) 
3<f>l  3*1 


=   (LH^]Tcp)1;   +  (c£T[H^jT);1 


(2-32) 


=   (<£TtC]);1  +  (^[H^]Tj;1 


since 

(^[H^]  )  ;1  =  [([H^J^)!.]1  =  1x1  (2-33) 
The  p^-h.  row  Qf  equation  (2-31)  can  be  written  as 


3  U.P  .  .  q-t       P  .  rn  ,     D  ,  .  rp ,     O  , 

+   (sMHpjT).  (cpHH^l  )  . 

3£ 


M 


(2-34) 


cpcp- 


21 


The  complete  Jacobian  of  equation  (2-31)  is  then 


3ji 
3« 


"cpcp- 


<pT[[H^]  +  [hLjt: 


p 


(2-35) 


yielding 


3$ 


u 


(2-36) 


where  the  transpose  operation  is  performed  plane  by  plane. 
The  last  partial  in  equation  (2-28)  can  be  separated  into 
two  parts,  giving 


3u..      9u.  . 
3jA  =   j£  +  (pep 

3<P      3<P  3<£ 


(2-37) 


where,  recalling  equations  (2-13)  through  (2-20), 

3iL 


3  2 


GU  CD 

3  S£ 

••Tr^1  iT 

cpx[  cpcpjx 


£T[H$<p]T 


(2-38) 
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■  SPT  t  H  "cp  ]  ^  =  P  X  M 


u 


and 


3u.  .  a>TrHU  nT<Pi 
32  32 


i         ci>T  H1  ,cp 
3(~  [  (pcpj    )    3(~  L  WJ-, 
B.<Pi  3cp2 


CP 


3(~  [  (p(p]~) 


3  <Pm 


qTH2 


CP, 


9(~  [  (P<p]~) 


(2-39) 


3  cp! 

I 

cpT  Hp  A 
3(~  [  gCJ 
3  q>i 


cpTrHp  £ 
3(~  [  <pcp]~) 


3  cpM 


Now 


3  4>i  3cPi 


(2-40) 


—  2TtDlW2  =1x1 


yielding 


3  u 
32 


2T[Dl<p(p]2  2TCD2(pcp]2 


£T£Dlcpcp]£ 


^TtDMcpcp]* 


2T[Dl(p(pJ2 


^TtDMcp<p^ 


(2-41) 


=  2TCD(p(p(p]2  =  P  x  M 
The  letter  (d,D)   is  used  to  denote  the  third-order  geometric 
derivative ,  and  the  shape  of  the  quantity  is  equal  to  the 
dimension  of  the  superscript  by  the  dimensions  of  the 
subscripts,  respectively.     Further  defining  the  third  order 
kinematic  influence  coefficient  (d,D)  one  has 


u 


.3  u 

3_JA  =  t  Dcpcpcp  J  =  PxMxMxM 
3  (p.3 

3^  =    [DQW]p;;;    =    [  D!p(pcp  ]  =1XMXMXM 

_3_(9jji)  -   [dJJwJ  ;1;  .   =   L Dicpcp  I   =  P  x  1  x  M  x  M 
<Pl  2 
3i£ 


(2-42) 


u     ,  P 

=  1x1x1x1 


_3(J_(iuJ)  =  LD(p(p(p]p;1;m;n.  =  dimn 


3<Pl  3<%  3<Pn 

Now,  substituting  equations  (2-38)  and  (2-41)  into  equation 
(2-37)  gives  the  partial  derivative  of  the  dependent 
parameter  acceleration  (u)  with  respect  to  the  generalized 
coordinate(  s )  position  (<f>)  as 

lii  =  £TLtWT  +  ^LD^li  (2-43) 
3  eg 

Finally,  from  equations  (2-28),   (2-30),    (2-36)  and  (2-43), 
the  third-order  time  derivative  (u)  of  the  dependent 
parameter  set  (u)  is 

£  ■-"  CSlcp  +  ^([H^j  +  CH^]T)£  +  (iT[Hjp]T  +  cpTi Dicpcp 32)fi 
=   tG^jcp  +  cpT(H^]   +  2[H^JT)6  +   (^T[D^WJ2)V  (2-44) 
completing  the  general  kinematic  development. 


Kinematics  of  Serial  Manipulators 

The  analytical  development  presented  here,  altered 
notationally  and  extended  to  cover  third-order  kinematics,  is 
based  directly  on  the  work  of  Thomas  (1981)  and  is  included 


for  completeness.     The  definition  of  the  particular  physical 
system  that  is  being  considered  is  addressed  first.     Then  the 
notation  defining  the  physical  parameters  is  established. 
Next,  the  geometric  relationships  corresponding  to  eguation 
(2-3)  are  developed.     Finally,  the  kinematics  of  the  serial 
manipulator  are  derived  in  terms  of  explicit  equations 
defining  the  kinematic  influence  coefficients  as  opposed  to 
the  conceptual  relationships  of  the  preceding  general 
development . 

System  definition  and  notation 

The  analytical  development  presented  here,  altered 
notationally  and  extended  to  cover  third-order  kinematics,  is 
based  directly  on  the  work  of  Thomas  (1981)  and  is  included 
for  completeness.     The  serial  manipulator,  in  essence  an  open 
loop  kinematic  chain  consisting  of  a  series  of  rigid  links 
joined  by  one-degree  of  freedom  lower-pair  connectors,  is 
illustrated  in  Fig.  2-1.  This  treatment  specifically 
addresses  only  revolute  (R)  and  prismatic  (P)  pairs  because 
most  other  typically  encountered  joints  can  be  considered  as 
combinations  of  the  two  (e.g.,  a  cylindric  joint  is  analyzed 
as  an  R-P  combination).  Investigation  of  Fig.  2.1  shows  that 
both  types  of  joints,  revolute  and  prismatic,  have  two 
independent  parameters  associated  with  them,   (Sjj,  9j )  and 
(sj,  ©jj),  respectively.  The  parameter  Sjj   (or  s j )  is  the 
offset  distance  along  the  joint  axis,  s^ ,  between  the  two 
links  connected  by  the  joint  connects.     The  parameter  9^  (or 


9jj)  is  the  relative  rotation  about         between  these  links. 
Here  the  double  subscript  serves  to  indicate  that  the 
quantity  is  a  fixed  independent  parameter,  while  the  single 
subscript  implies  that  the  parameter  is  an  independent 
variable.  The  two  parameters  a-jk,  the  fixed  distance  between 
joints  j  and  k  as  measured  along  their  common  perpendicular 
a_3k,  and  ou^,  the  twist  angle  between  the  joint  axes  measured 
in  a  right-hand  sense  about  a3k,  define  link  jk. 

The  global  reference  is  a  fixed  Cartesian  system  (X,Y,Z) 
with  the  Z  axis  directed  along  the  first  joint  axis,  s^,  and 
the  X  axis  located  arbitrarily  in  the  plane  perpendicular  to 

(Note  that  the  independent  parameters  associated  with 
joint  one  are  measured  with  respect  to  the  X  axis).  Local  (or 
body-fixed)  dextral  Cartesian  reference  systems  ((^x,  ^)y, 
^j'z),  with     (^x  along  a.jk  and  along  s  3  ,  are  assigned 

for  each  link  (jk).  The  vectors  a^k  and  s_3  are  unit  vectors 
expressed  in  terms  of  direction  cosines  and  given  by 
*aJk  =  t^U^  =  (*X^k,   *Y^k,  *z3k) 

(2-45) 

*sJ  =  T^  H )s^  =  (*XJ,   *Y3,  *ZJ) 

with 

(^a3k  =  (1,  0,  0)T 


(3)s3  =  (o,  o,  l) 


(2-46) 
T 


where  the  rotational  transformation  matrix  T^  is 

Ti  =  [*a^k  s^x*a^k  *s^]  (2-47) 
The  preceding  superscript,  (j),  is  used  to  indicate  that  the 
vector  is  expressed  in  terms  of  the  jth  local  reference,  and 
the  preceding  superscript  (*)  denotes  a  vector  given  in 


terras  of  its  direction  cosines.     The  direction  cosine 
representation  of  the  vectors  aj^  and  s?  can  be  obtained, 
where  all  joints  are  assumed  to  be  revolutes,  from  the 
initial  direction  cosines 

*s1  =  (0,  0,  1)T 

(2-48) 

*a12  =  (c@lr  s9x,  0)T 
and  the  recursive  relations 

*s?  =  T^"1(^_1)s^  =  T^-1(0,-sa( j ,  ca(j_1)jj)T 

j  =  2  ,  3  ,  .  .  .  ,M  (2-49) 
*a3k  =  T^-^j-Da.^  =  Tj _1  ( c9j  ,  ca(  j  _x }  j  s9  j ,  sa(  j  _x }  j  s9  j ) T 

where  c6  =  cos9,  s9  =  sin9,  etc. 

If  the  joint  is  prismatic,  simply  replace  9]_  by  9]_j_  and  S]_]_ 
by  S]_  here  and  in  the  subsequent  general  equations.  Finally, 
the  position  vector,  R  j ,  locating  the  origin  of  the  j*-*1 
reference  is  given  by 

Rj  =  sill1  +  j2(a(l-l)ia(1"1U  +  siLsl) 

(2-50) 

Using  equations  (2-48),  (2-49)  and  (2-50),  the  configuration 
of  the  serial  manipulator  is  completely  defined  once  all  the 
zero-th  order  independent  parameters  are  specified  (e.g., 

sll'.  a(l-l)l'  a(l-l)l'  ®1'  etc«)«     The  reverse  position 
solution,  that  of  solving  for  the  variable  input  parameters 
given  the  desired  hand  location  (e.g.,  R6 ,  a67,  s 6 ) ,  is  (in 
general)  considerably  more  difficult  (Duffy,   1980)  and  is 
not  addressed  here.     The  notation  involved  in  the  kinematic 


Figure  2-1.     Kinematic  representation  of  the  serial 
manipulator 
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Table  2-1.     Manipulator  Joint  and  Link  Parameters 


S_J     -  Vector  for  Joint  Axes  Between  Links 

Sjj  is  Fixed  Offset  Value  (Revolute) 
0jj  is  Fixed  Rotation  Value  (Prismatic' 


cp- 


Generic  Input  for  Joint  Axis  S? 
Sj     -    Sliding  Along 
9j     -    Rotation  About  S? 


a]k 
ajk 


,  -    Fixed  Link  Dimensions  Between  Axes  j  and  k 

a-j^    -    Common  Perpendicular  Along  a^ 
aj^    -    Twist  Angle 
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Table  2-2.     Coordinate  Systems 


GLOBAL  SYSTEM 

Y 


l2| 


Absolute  Reference  System 
( Z  Along  Axis  S1 ) 


Y^ 


Direction  Cosines  for  Joint 


*xJk\ 

*Yjk 

*z3k 


D 


irection  Cosines  for  Link  a^k 


LOCAL   ( j )  SYSTEM 


(j)Y 
(j)z 


Body  Fixed  System  for  Link  jk 
( j  >X  along  a^k 
(  j  >Z  along  S^k 


representation  of  the  serial  manipulator  is  given  in  Tables 
2.1  and  2.2  for  quick  reference. 
First-order  kinematics 

In  the  development  of  the  generalized  kinematics,  the 
specific  nature  of  the  dependent  motion  parameters  (up)  and 
the  independent  input  parameters  (0n)  were  not  taken  into 
account.  In  the  case  of  the  serial  manipulator  there  is  a 
fundamental  difference  in  the  nature  of  the  two  basic  motion 
parameters  considered.     In  this  treatment  the  two  parameters 
are  the  cartesian-referenced  link  orientations  (which  are  not 
considered  true  coordinates)  and  the  cartesian-referenced 
coordinates  of  a  point  (which  are  true  coordinates).  Also, 
the  effect  of  an  input  on  these  parameters  depends  on  whether 
the  input  is  a  revolute  or  prismatic  joint.  In  light  of  these 
facts,  the  kinematics  for  rotational  parameters  amd  those  for 
translational  parameters  are  treated  separately,  and  the 
results  for  both  revolute  and  prismatic  inputs  are  given  in 
each  case. 

In  dealing  with  the  kinematics  of  rotational  parameters, 
it  is  not  convenient  to  start  with  an  equation  of  the  form 
of  equation  (2-1)    (i.e.,  u  =  f(cg))  since  finite  angles  of 
rotation  cannot  be  represented  by  vectors.  Fortunately, 
however,  it  is  possible  to  represent  infinitesimal  rotations 
by  vectors  (Meirovitch,  1970),  and  these  infinitesimal 
rotations  can  most  readily  be  interpreted  as  the  angular 
velocity  (co)  of  the  body.     So,  instead  of  using  a 
zeroth-order  holonomic  constraint  equation  (e.g.,  u  =  f  ( eg )  ) 


to  derive  a  link's  first-order  rotational  influence 
coefficients,  a  first-order  non-holonomic  constraint 
equation  expressing  the  link's  angular  velocity  (oj_^k)  is 
used. 

Referring  to  Fig.  2-1,  the  angular  velocity  addition 
theorem  gives  the  angular  velocity  of  link  jk  as 

simply  the  sum  of  the  relative  angular  velocities  between 
preceding  links  in  the  chain 

0)3*  =  S  0n  sn,  n  =  1,2,. ..,L  (2-51) 
—  n=l  - 

where,  6nsn  is  the  relative  angular  velocity  between  links 
(n-l)n  and  n(n+l),  and  0n  is  identically  zero  for  a 
prismatic  joint.  Investigation  of  equation  (2-51)  shows  that 
the  angular  velocity  (w3k)  can  be  separated  into  a  function 
of  position  (i.e.,  sn  =  f(cg)  operated  on  by  a  function  of 
time  (i.e.,  9  =  ©_(t))  or,  in  the  form  of  equation  (2-7), 

Jk  =  f(ffi,*e<t)  ~=  [oJkJi  (2_52) 

Now,  in  order  to  obtain  the  3xM  configuration  dependent 
matrix  [G^,  ],  one  has  that  (also  see  equation  (2-12)) 

_3  (u^)   =  _3_(  [cjk]£) 

=   [G^]  3(2)  (2_53) 

=  [GJk] 
<p 

In  fact,  for  any  position  dependent  vector  (u  =  u(<f>)  ) 
one  has  from  calculus  that 


_3_(_d(u))  =  3  (  3  (u)dcp) 
cpn  dt  3cpn  3cp_  dt 


=  3(&) 
3  cp      3  <i>n 

(2-54) 

=  C  9(a)] 

3  cp  '*n 

=  9(u) 
3  cp 


This  turns  out  to  be  a  very  convenient  relationship  and  is 
used  to  obtain  the  kinematic  influence  coefficients  for 
translational  parameters  even  though  it  is  not  necessary 
since  the  position  vector  u  =  P  =  (XP,  YP,  ZP)T  exists  and 
could  be  differentiated  directly. 

Returning  to  the  question  at  hand,  from  equations 
(2-51),   (2-52)  and  (2-53),  the  rate  of  change  of  the  angular 
orientation  of  link  jk  is 

^  •   <-%k  1*  (2-55) 

where 


=  _3_(w:ik)  =   3_(  ,S    ^  s1) 

n         vpi  i— 1 


^n  ^n  (2-56) 

sn,  n  <  j ;  cpn  =  9n  (revoiute) 

o  ,  otherwise 

Here,  the  angular  velocities  (e.g.,  o)_3k)  are  expressed  in 
terms  of  cartesian  reference  frames  and  denoted,  in  a 
component  sense,  as 

wjk  =  ((j0jx/  00jy/  ujz}T  (2-57) 
Consistent  with  this  notation,  the  influence  coefficients 
take  the  form 


gjk    =     (gjX       gjy,  gjZ)T 

n  n        n  n 


(2-58) 


where 

sn  =  (*Xn,   *Yn,   *Zn)T  (2-59) 

The  translational  velocity  (P)  of  a  point  (P)  in  link  jk, 
and  hence  (from  equation  (2-54))  the  translation  influence 
coefficients,  can  be  derived  from 

p  =  Rj   +  T^^P  (2-60) 

where,  is  the  location  of  point  P  in  terms  of  the  body 

fixed  reference  j,  and  multiplication  of  by  the 

rotation  matrix        transforms  the  coordinates  from  the  jth 
reference  to  an  intermediate  system  with  the  same  origin  but 
with  axes  parallel  to  the  global  reference  (X,  Y,  Z). 
Substituting  equation  (2-50)  for  FJ  and  differentiating 
equation  (2-60)  gives  the  velocity  of  point  P  in  link  jk  as 

I  =  sis1  +    I     (a(1_1)1a<1-1>1  +  s^s1  +  s^1) 

(2-61) 

+  _d(T^(^P) 
dt 

Now,  since  a11"1^1  and  s1  are  unit  vectors  fixed 
in  link  (1-1)1  and  (T^^P)  is  a  vector  fixed  in  link  jk,  the 
time  rate  of  change  of  these  vectors  can  be  expressed  in 
terms  of  the  vector  cross  product  as 


(1-1)1  =  u(l-l)l  x  ad-Dl  =(  1s1  Qn  sn  )    x  afHU 

(2-62) 


n=l     n  " 


s1  =  JHH  x  s1  =(^11  ©n  £n)x  s1 
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d(Tj(j)p    =  Jk  x  (T3(3)p)  J  liX  9n  sn  )  x  (T3U)P) 

dt  \n=i  y 

Substitution  of  equations  (2-62)  into  equation  (2-61)  and 
reqrouping  of  terras  leads  to 

P  =    1    {snsn  +  6nsn  x  [1J.1(a(i-l)l*(1"1)1  +  nil1) 
n=l  x-n-ri 

+  T^(3)p]} 

(2-63) 

=     I  {snsn  +  9nsn  x  (P-Rn)} 
n=l 

where,  referring  to  Fig.  (2-1), 

=n+l U(  1"1  ]1-  1-1,1  +  Sll-i}  +  Tj(j)^  =  (^n) 

(2-64) 

is  a  vector  from  the  origin  of  the  nth  reference  to  the 
point  P.  Finally,  recalling  equation  (2-54),  the  velocity  of 
point  P  can  be  expressed  in  the  form 

P  =   [G^jcp  (2-65) 

where 

/  s n  x(P-Rn)    ,  n<j;  cpn=Sn  (revolute) 


2n  =  iL-  =  \ 
9<Pn 


sn  ,  n< j ;  <Pn=sn  (prismatic) 

(2-66) 


o  ,  n>3 

Second-order  kinematics 

Now,  relying  heavily  on  the  development  presented  for 
the  second-  and  third-order  kinematics  of  a  general  motion 


parameter,  the  higher-order  kinematic  influence 
coefficients,  and  hence  the  higher-order  kinematics  for  the 
serial  manipulator,  can  be  obtained  by  directly  operating  on 
the  first-order  coefficients  given  in  eguations  (2-27)  and 
(2-66).     Observing  that  both  the  rotational  and 
translational  influence  coefficients  are  expressed  in  terms 
of  position  dependent  vectors  leads  one  to  again  use  the 
relationship  of  eguation  (2-54)  to  obtain  the  (h,H)  and 
(d,D)  functions. 

Recalling  the  first-order  rotational  coefficients  and 
eguations  (2-54),  one  has 


d(g^k)  =  i 
dt  n 


sn  ,  n<3  ;  cpn=9n 
o     ,  otherwise 


(2-67) 


where 

n=l 


sn  =/  7S     9i  s1     x  sn  (2-68) 


Performing  the  partial  differentiation  with  respect  to  the 

mth  generalized  velocity  yields,  for  the  second-order 

rotational  coefficients,  the  expected  non-symmetric  (i.e., 

h?k  =  hjk)  result 
-mn  — nm 


=  _l_(qik)   =  _8_(g^k)  =< 
"mn      9<Pm    n  ^m  n 


sm  x  sn  ,  m<n<j   ;  <Pm=9m,  (Pn=©n 

(2-69) 

o  ,  otherwise 
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Also,  notice  that  the  rotational  (h,H)  functions  are  zero  if 
either  input  is  prismatic.  Referring  to  the  general  form  of 
equation  (2-27),  the  angular  acceleration  of  link  jk  becomes 

aj*  =  [G^]a  +  cpT[H^]cp  (2-70) 
cp            -      cpcp  - 

where 

a?*  =  (aJx,  a3Y,  a^z)T  (2-71) 

and 

[Hjk]  =  3  x  M  x  M  (2_72) 

with 

[H^]        =       =  (h^,  hjy,  hjz,T 

cpcp  ;m;n      ~~mn  mn      mn      mn  y* 

The  second  order  kinematics  of  a  point  P  in  link  jk  are 
perhaps  most  easily  understood  by  identifying  all  possible 
input  combinations  and  addressing  each  situation 
independently.  Looking  first  at  the  case  where  the  nth 
generalized  coordinate  is  a  prismatic  joint  (i.e.,  cpn  =  sn)  , 
the  time  rate  of  change  of  the  (g,G)  function  is 

kl  =  in  ,  n<j   ;  cpn=sn  (2_74) 

Since  sn  can  be  viewed  as  a  unit  vector  fixed  in  link 
(n-l)n,  one  has  that 

gP  =  .(n-l)n  x  £n  =^1  ^  ^  x  ^  ^  ^. ; 

(2-75) 

Taking  the  partial  derivative  of  this  expression  yields,  for 
a  prismatic  joint  n 


hp  =  9  (gp)  =< 
~mn  n  | 


3<p 


m 


sm  x  sn  ,  m<n<j   ;  <Pm=©m,  <Pn=sn 
o         ,  n<m<j   ;  cpm=9m,  0>n=sn 

(2-76) 


Now,  considering  the  case  where  the  nth  joint  is  a  revolute 
(i.e.,  cpn  =  9n)  ,  the  time  rate  of  change  of  the  influence 
coefficient  is 

■ 

gP  =  s_n  x  (P-Rn)   +  sn  x  (P:Rn)  (2-77) 

or,  by  differentiating  eguation  (2-64)  to  obtain     (P-Rn)  and 
substituting  the  cross  product  form  of  equations  (2-62)  for 
the  vector  derivatives , 


•  p 

g* 

-n 


=     (  ( 


n=l 


2  8^  s1)  x  sn)  x  (P-Rn) 
i=l  ~~ 


(2-78) 


+  sn  x  (     I     [(1S18i  s1)  x  (a/i.ina^-1)1  +  s^1)] 

-  l=n+l      1=1    X   ~  vx 

-t-  (   i    6i   s1)  x  (T^^P)) 
1=1     1  - 

+  sn  X   (      I       Si  s1) 
l=n+l     1  ~ 


Investigating  the  case  where  the  mth  input  is  a  prismatic 
joint  (i.e.,  cpm  =  sm)  ,  one  see's  immediately  from  the  last 
term  of  the  preceding  equation  that 


,p  ~gr 

hmn  =  3-n  = 


3s 


m 


sn  x  sm  ,  n<m<j   ;  cpn=©n,  <Pm=sm 
o        ,  m<n<j 


(2-79) 
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The  reader  should  note  that  this  equation  is  consistent  with 

equation  (2-76)  and  shows  that  the  result  is  non-zero  only 

if  the  revolute  precedes  the  prismatic  joint  in  the  serial 

P  P 

chain.     The  symmetry  (i.e.,  h^n  =  h_nm)  of  the  translational 
(h,H)  functions  should  also  be  noted.     Now,  when  the  m^ 
input  is  also  a  revolute  (i.e.,  <pm  =  8m)  it  is  best  to  look 
at  the  case  in  two  steps.  First,  when  m  >  n,  from  the  second 
term  of  equation  (2-78) 

g^n  =  sn  x  (sm  x  [,  i  1  (a(1_1)la(l-l)l 

~         ~         l=m+l     U  (2-80) 

+  s^s1)  +  tJO)£)) 

or,  from  equation  (2-64) 

9-n  =  sn  x  (sm  x  (P-Rm))    ,  n<m<j 

99^  (2-81) 

If  m  <  n,  both  of  the  first  two  terms  in  equation  (2-78)  are 

involved  and,  one  finds  that 

-n  =  (sm  x  sn)  x  (?-Rn) 
9^  (2-82) 

+  sn  x  (sm  x  (     I     (an_q  na^1"1)1  +sllsi  +  T^(^P)) 
l=n+l  -  - 

or,  again  recalling  equation  (2-64) 

d-n  =  (sm  x  sn)  x  (P-Rn)   +  sn  x  (sm  x  (P-Rn)) 

=  sm  x  (sn  x  (P-Rn))    ,  m<n<j  (2-83) 
Combining  this  result  with  that  of  equation  (2-81)  further 
illustrates  the  symmetry  inherent  in  the  translational  (h,H) 
functions  and  yields 
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pp.. 
hjnn  =  hmn  =  s1  x  (s?  x  (P-pJ))   ,  i  =  min  (m,n) 

j  =  max  (ra/n) 

(2-84) 

Before  proceeding  with  the  kinematic  development,  it 

will  prove  beneficial  to  reinvestigate  a  representative 

sampling  of  the  first-  and  second-order  translational 

influence  coefficients  in  a  more  geometric  light.  Recalling 

equations  (2-8)  and  (2-66),  the  first-order  geometric 

influence  coefficient  for  a  point  P  in  link  jk  with  respect 

P 

to  the  ntn  input  is  a  vector  (g^  )  which  when  multiplied  by 
the  nth  generalized  velocity  (<pn)  yields  the  nth  partial 
velocity  (Pn)  of  the  vector  (P) 


P  =    I  Pn  =    I    g_p  rj>      g_p  =  0  ;  n>j 
n=l         n=l    n    n  n 


(2-85) 


Let  us  first  investigate  the  case  where  the  nth  input  is  a 

prismatic  joint  (i.e.,  cpn  =  sn)  and  the  desire  is  to  find 
p 

(sg_n).  Here,  the  preceding  subscript  (s)  is  introduced  to 
indicate  that  input  n  is  prismatic.     Referring  to  Fig.  2-2, 
one  can  readily  see  that  the  vector  (P) ,  and  hence,  its 
velocity  (P) ,  can  be  expressed  in  a  variety  of  ways.     In  the 
manipulator  of  Fig.  2-2,  where  the  second  joint  is  prismatic 
(i.e.,  cp2  =  s2),  it  is  advantageous  to  view  the  vector  (P) 
as 

P  =  r2  +  (p-r2) 

(2-86) 
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Here  the  quantity  (P-R2)  is  considered  a  free  vector 
and  the  pure  translation  of  a  free  vector  in  no  way  alters 
the  vector  (i.e.,   (P-R2)=0).  With  this  representation  it  is 
readily  apparent  that  the  action  of  the  slider  (s2)  only 
affects  the  vector  ( R2 )   .     Also,  by  inspection,  the  rate  of 
change  of  this  vector  (R2),  and  therefore,  the  rate  of 
change  of  P  due  to  the  action  of  s2/  is 

£2  =  ^2  =  s2s2  (2-87) 

since 

R2  =  s^s1  +  a12a12  +  s2s2  (2_88) 
From  equation  (2-77)  one  obtains  the  expected  result  (see 
equation  ( 2-66  )  ) 

s2n  =  sn  ,  n=2  (2-89) 
Now,  consider  the  derivation  of  the  (g,G)  function  for  a 
revolute  joint  (e.g.,  cpn  =  63 )  .     In  this  situation,  the 
coefficient  (923)  is  most  easily  found  by  expressing  the 
position  vector  P  as 

P  =  R3  +  (P-R3)  (2-90) 
In  this  case  it  is  the  vector  R3  that  is  unaffected  by  the 
action  of  the  revolute  (83).     Recalling  the  vector  cross 
product  representation  of  the  velocity  of  a  body  fixed 
vector,  one  has  the  partial  velocity  of  P  due  to  the  third 
input  as 

E3  =  d:R3)3  =  ©3£3  x  (P-R3)  (2_9i) 
since  (P-R3)  can  be  viewed  as  a  vector  fixed  in  link  34. 
This  again  yields  the  expected  result  (see  equation  (2-66)) 


Figure  2-2.     First-order  kinematic  influence  coefficients 
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Qgl  =  sn  x  (P-Rn)    ,  n=3  (2-92) 
The  difference  between  the  translational  first-order 
coefficients  for  revolute  and  prismatic  joints  is  perhaps 
more  easily  understood  now,  from  equations  (2-86)  through 
(2-92),  than  from  the  more  analytical  development  resulting 
in  equation  (2-66).  That  is,  by  expressing  the  vector  (P)  as 


P  =  Rn  +  (P-Rn; 


(2-93) 


it  becomes  obvious  that,  if  the  ntlri  input  is  prismatic 

(i.e.,  8n  =  sn)  the  location  of  the  origin  of  the  local 

reference  (Rn)  fixed  to  link  n(n+l)  is  translated  and,  if 
the  n*-*1  input  is  a  revolute  (i.e.,  cpn  =  0n)  the  vector 

(P-Rn)  from  the  local  origin  to  the  point  of  interest  is 
rotated. 

To  reinterpret  the  second-order  coefficients  (i.e., 

h     ),  take  the  case  where  the  n*-n  joint  is  a  revolute. 
—  mn 

Here,  referring  to  Fig.  2-3,  one  has 

9£n  =  sn  x  (P-  Rn)  (2-94) 
P 

First,  if  m  <  n,  one  can  obtain  (hmn)  immediately  by  noting 
P 

that  (g2  )  as  expressed  in  equation  (2-94)  represents  a 
vector  fixed  in  link  n(n+l).     From  the  first-order  results 
it  follows  that 

p 

sellmn  =  2  ,  m<n<j  (2-95) 


ana 


ee^Jnn  =  £m  x  (s11  x  (P-Rn)  )    ,  m<n<j  (2-96) 


Figure  2-3.     Second-order  kinematic  influence  coefficients 
when  second  joint  is  a  revolute 
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P  n 

since  (9^)  is  affected  in  the  same  manner  as  (P-Rn)  was 
previously.     Now,  if  m  >  n,  the  first  step  is  to  reexpress 
equation  (2-94)  as  (see  Fig.  2-4) 

92n  =  sn  x  [(P-Rm)  +  (Rm-Rn)]  (2_97) 

Here,  from  past  results,  it  can  be  seen  that  if  the  m*-*1 
input  is  a  prismatic  joint  only  the  vector  (Rm-Rn)  is 
effected.     On  the  other  hand,  if  the  mth  input  is  a  revolute 
the  only  affect  is  on  the  vector  (P-Rm) .     This  gives  the 
second-order  results  as 

P         _  _ 
seW  =  5.    x  *     ,  n<m<j 

(2-98) 

and 

P 

QG^mn  =  sn  x  (sm  x  (P-Rm) )    ,  n<m<j  (2-99) 

The  remaining  second-order  influence  coefficients  are  left 
for  the  reader  to  reinterpret  and  compare  with  the  more 
analytically  derived  equations  (2-76),   (2-79),    (2-81)  and 
(2-83)  . 

Now,  with  the  second-order  influence  coefficients  fully 
established,  the  acceleration  of  point  (P)  can  be  obtained 
as 

P  P 
I  =   [Gq,]^  +  $TtHw]$  (2-100) 


where 

p   =    fyP      YP  7P)T 

—  (2-101) 

and 


Figure  2-4.     Second-order  kinematic  influence  coefficients 
when  first  joint  is  a  revolute . 


[Ht0fD]   =  3  x  M  x  M 


(2-102) 


with 


P 


PX 
mn ' 


=  h, 


=  (hi 


h. 


;m;n 


;n;m 


(2-103) 


Third-order  kinematics 

The  third-order  kinematics  require  the  development  of 
the  third-order  influence  coefficients  (i.e.,  the  (d,D) 
functions).  Here,  only  a  few  representative  cases  will  be 
derived.     The  rotational  coefficients  are  obtained  via  the 
strict  analytic  approach,  whereas  the  translational 
coefficients  are  addressed  using  the  more  illustrative 
graphic  approach.     The  complete  third-order  coefficient 
results,  along  with  those  for  the  first-  and  second-order 
coefficients  are  presented  in  Tables  2-3,   2-4  and  2-5. 

Again,  the  rotational  influence  coefficients  will  be 
investigated  first.     Here,  if  any  of  the  three  inputs 
involved  is  a  prismatic  joint,  then  the  third-order 
geometric  derivative  is  identically  zero.     This  result  is 
due  to  the  fact  that  the  translation  of  a  free  vector  does 
not  alter  the  vector  (as  was  also  the  case  for  the  (h,H) 
function).     Now,   if  all  inputs  considered  are  revolutes,  one 
has 


r 


X  s 


n 


m<n<  j 


eeiimn 


=  < 


(2-104) 


o 


n<m 


and  the  concern  is  to  determine  the  effect  of  the  third 

revolute  (q>]_  =  0j_)  on  this  second-order  property.  There 

are  two  unique  non-zero  situations  nere,  i<ra<n  and  m<l<n. 

i  k 

If  l<m<n,  then  hJ    can  be  considered  as  a  vector  fixed  in 
— mn 

link  (m-l)m  and  the  third-order  geometric  derivative  is 

(2-105) 

=  s-1-  x  (sm  x  snj    ,  Km<m<j 

If  m<l<n,  then  sm  is  unaffected  by  the  1th  input  and  sn  can 
be  considered  as  a  vector  fixed  in  link  (n-l)n  yielding 

eee^lran  =  sm  x  jL-((^  ©i  l1)  x  sn)  (2-i06) 
=  sm  x  (s1  x  sn)   ,  m<Kn<j 

One  can  now  write  the  time  rate  of  change  of  the  angular 
acceleration  of  link        as  (see  equation  (2-44)) 

ijk  =  [Gjk]£  +  pT[[Hjk]  +  2[H3k]T](j, 
(p  cpcp  cpcp 

(2-107) 

+  (^TtDW(p]2)6 

where  all  algebraic  operations  are  as  defined  previously  in 
the  general  kinematics  section  and 

[D^]   =  3  x  M  x  M  x  M  (2-108) 

with 

LDcpcp<pl  ;1;m;n  "  -lmn  "  (dlmn'dlmn'  dlmn> 

(2-109) 
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The  third-order  translational  coefficients  where  one  of 
the  inputs  is  prismatic  can  be  obtained  in  exactly  the  same 
manner  as  were  the  rotational  coefficients  for  three 
revolute  inputs  ( since  the  symmetry  exhibited  by  the 
second-order  translational  coefficients  carries  over  to  the 
higher  order  properties),  where 

_9_(_i_(         )  =  JMJUAiL)  )  =  ••• 

3sn  36x  38m  3ej_  39m  3sn  (2-110) 

As  with  the  translational  (h,H)  functions  the  only  non-zero 
result  occurs  when  the  prismatic  joint  is  the  last  joint 
considered  and  can  be  expressed  as 

P  P  ■  ■ 

sSQ^nlm  =  ees^lmn  =  • • •  =  s1  x  (s3  x  sn)   ,  i=min  (l,m) 

j=max  (l,m) 
(2-111) 

Considering  the  situation  where  all  three  inputs  concerned 
are  revoiutes,  and  m<n< j ,  one  has 

P 

h^p  =  sm  x  (sn  x  (P-Rn) ) 

"         ~  ~  (2-112) 

Taking  the  more  graphic  approach  (see  Fig.  2-5),  for  l<m, 
P 

(hmn)  can  be  considered  as  a  vector  fixed  in  link  m(m+l), 
yielding 

d_lmn  =  s1  x  (sm  x  (sn  x  (P-Rn)  )  )   ,  l<m<n<j 

(2-113) 

For  m<l<n,  the  vector  sm  is  not  effected  and  (s_n  x  (P-Rn)  ) 
can  be  viewed  as  a  vector  fixed  in  link  n(n+l),  giving 


Figure  2-5.     Third-order  kinematic  influence  coefficients 
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chmn  =  sm  x  (s1  x  (sn  x  (P-R11)))   ,  m<l<n<j 

(2-114) 

Finally,  for  m<n<l,  by  reexpressing  (P-Rn)  in  equation 
(2-112)  as  [(P-R1)  +  (R1-!*11)]  one  sees  that  the  only 
affected  vector  is  (P-R1),  so 


d-Lmn  =  sm  x  (sn  x  (s1  x  (P-R1)))   ,  m<n<l<j 

(2-115) 


The  remaining  translational  third-order  geometric 
derivatives  are  left  for  the  reader  to  derive  and  are  given 
in  Table  2-3.     The  time  rate  of  change  of  the  acceleration 
of  a  point  P  in  link  jk  can  now  be  expressed,  from  equation 
(2-44),  as 


P  P  m  P 

1'  =   [G<p]£  +  3cpT[HwlQ  +   [&T  [Delate 


(2-116) 


where 


with 


P 

[D<p<p<p]   =  3xMxMxM  (2-117) 


P  P 
[D<PW];l;m;n  "  "lmn  (2-118) 


and  the  symmetry  of  the  translational  (h,H)  functions  has 
been  observed  (i.e.,  [H^(p]T  =  [H^l).  This  completes  the 
treatment  of  the  kinematics  of  serial  manipulators. 
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Table  ?-1 

Pi  T"  Q  +"    nrHpT"    T'n-f-1  nonpQ       r>&"F  ~F  i  r*  i  nn-t-c 
r  _L  i.  o  U    UIUcI     X  IIJ- J_  U-tJIIL-G  LUcIIlLlcnCS 

for  Serial  Manipulators 

T  Ml)  V%  y-^  J 

oyTTlDOX 

Joint  Type 

at  M        at  N  Restrictions 

Value 

Rotational 

n<j 

Sn 

CP 

n>j 

0 

All  n 

0 

Translational 

R  n<j  Sn  x  (P-Rn) 

[^GP]n 

*  -  P  n<j  sn 

R,P  n>j  0 
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Table  2.4  Second  Order  Influence  Coefficients 

for  Serial  Manipulators 


Symbol 


Joint  Type 
At  M      At  N 


Restrictions 


Value 


Rotational 


cpcp 


'm;  n 


R 
R 


R 
R 


m<n<  j 

m<n  or  n>j 


p 

P 

All  m,n 

R 

p 

All  m,n 

R 

R 

m<n<  j 

R 

R 

n<m<  j 

P 

R 

n<ra<  j 

R 

P 

m<n<  j 

P 

R 

m<n<  j 

R 

P 

n<m<  j 

R,P 

R,P 

(m  or  n) 

Sm  X  Sn 

0 
0 
0 


Translational 
cpcp 


Smx[Snx(P-Rn) ] 
Snx[Smx(P-Rm) ] 
SnxSm 
SmxSn 

0 
0 
0 
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Table  2-5.     Third-order  Influence  Coefficients  for  Serial 

Manipulators 


Joint  Type 

Symbol  Iran    Restrictions  Value 


KOLdtionai  k 

■n 

K 

K 

ism<ns j 

CI./  /  nOlw nil  1 

£S   X  (  SmXS  ) 

r  n  j  k  i ,  □ 
<-u       l  •m-n  K 
cpcptp  -1 ' 111 '  " 

D 

D 
K 

Ills.  1^  J 

o   X I b   Xb  J 

D 

o 

K 

D 

in ,  liii  or  n  j 

u 

P 

all  l  ,m ,  n 

y 

R 

rr>P     l , 

cpcpcp  -1- ' 111 ' 11  ^ 

R 
R 

R 
R 

l<m<n<j 
m<l<n< j 

S1x(Smx[Snx(P-Rn) ] ) 
Smx(S1x[  S_nx(P-Rn)  ]  ) 

K 

K 

K 

ni<n<iS] 

S"'X  (  Sx  L  S  -"-X  (  P-Rx  )  J  ) 

R 

R 

R 

n<m 

by  symmetry 

R 

R 

P 

l<m<n<j 

S1x(SnacSnJ 

R 

R 

P 

m<l<n< j 

s^s^s11) 

R 

R 

P 

m,l<n  or  n>j 

0 

R 

P 

P 

all  other 
l,m,n<j 

by  symmetry 

P 

P 

all  l,m,n 

0 

l,m,n>j  0 


54 

The  Dynamic  Model 

This  section  deals  with  the  determination  of  the 
generalized  input  loads  (forces  and,  or  torques)  required  to 
cause  the  system  in  question  to  undergo  some  arbitrary 
desired  motion.     The  derivation  of  the  describing  equations 
presented  herein  is  based  almost  entirely  on  two  fundamental 
principles  of  mechanics  (the  principle  of  virtual  work  and 
d'Alembert's  principle).  Lagrange's  equation  could  have  been 
employed,  yielding  the  same  results  (typically  in  scalar 
form  as  in  Thomas,  1981).     However,  it  is  felt  that  the 
approach  taken  here  more  directly  stresses  the  geometric 
nature  of  the  result. 

The  principle  of  virtual  work  is  used  to  obtain  the 
generalized  forces  (or  torques)  necessary  to  counteract 
externally  applied  loads  and  put  the  system  in  a 
configuration  (i.e.,  position)  dependent  static  equilibrium. 
This  principle  has  been  employed  by  many  researchers  (e.g., 
Whitney,  1972,  Paul,  1972  and  Thomas,  1981)  to  deal  with 
loads  applied  to  the  end-effector  of  a  serial  manipulator. 
It  can  also  be  used  to  handle  loads  generated  by  such  system 
components  as  springs  and  dampers  as  demonstrated  by 
Benedict  and  Tesar  (1978b)  and  Freeman  (1980). 

D'Alembert's  principle  is  used  in  conjunction  with  the 
principle  of  virtual  work  to  address  the  system's  inertial 
dynamics.     This  approach  to  determining  the  generalized 
inertial  loads  is  not  unique  to  the  author  and  has  been 
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observed  by  several  investigators  (e.g.,  Kane,  1961  and 
Silver,   1982).     One  form  of  the  equations  resulting  from 
this  approach  has  even  been  referred  to  recently  (by  Kane 
and  Levinson,  1983)  as  Kane's  dynamic  equations.  The  concept 
(alluded  to  as  early  as  1923  by  Wittenbauer ) ,  however,  is  a 
natural  consequence  of  the  two  principles  and  is  usually 
referred  to  as  the  generalized  principle  of  d'Alembert  (see 
Lanczos,  1962,  Meirovitch,  1970  and  Lee,  1982). 

Finally,  the  dynamic  equations  are  expressed  in  terms  of 
configuration  (i.e.,  position)  dependent  coefficients 
operated  on  by  the  higher-order  generalized  input  coordinate 
kinematics  (i.e.,  velocity  and  acceleration).     This  result 
for  the  dynamic  model  is  greatly  facilitated  by  the  use  of 
kinematic  influence  coefficients  and  yields  a  highly 
geometric  description  of  the  system  dynamics  where  the 
effect  of  the  action  of  the  generalized  coordinates  on  each 
other  is  transparent.     It  should  be  noted  that  this 
transparency  is  of  extreme  importance  (if  not  absolutely 
necessary)  when  dealing  with  the  transfer  of  the  dynamic 
model  from  one  set  of  generalized  coordinates  to  another. 

The  Principle  of  Virtual  Work 

This  principle  is  the  first  variational  principle  in 
mechanics  and  aids  in  the  transition  from  Newtonian 
(Vectorial)  dynamics  to  Lagrangian  (Analytical)  dynamics. 
It  is  concerned  with  the  static  equilibrium  of  mechanical 
systems,  and  can  be  stated  as:  The  work  done  by  the  applied 
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forces  in  infinitesimal  reversible  virtual  displacements 
compatible  with  the  system  constraints  is  zero.     To  get  a 
more  analytical  handle  on  this  principle,  consider  a  system 
containing  N,  P-dimensional ,  dependent  motion  parameters 
L\x  =  (iu1,  iu2,  i-u^1  ,  i  =  1,2,...  ,N 

(2-119) 

acted  on  by  N,  P-dimensional ,  applied  loads 

iTu  =  (iTl    iT2    iTP)T      i=1>2  n 

(2-120) 

where  the  preceding  superscript  indicates  which  parameter 
is  being  considered,  and  the  applied  loads  can  be  viewed  as 
implicitly  dependent  on  the  generalized  coordinates. 
Further,  suppose  that  the  system  has  M  degrees-of -freedom 
and,  hence,  its  motion  can  be  completely  described  in  terms 
of  M  generalized  inputs, 

q  =  (qi,  <l2''"'  ^T  (2-121) 
and  that  these  coordinates  are  acted  on  by  M  generalized 

forces 

Tq  =   (Tlf   T2,  TM)T  (2-122) 

For  the  system  to  be  in  static  equilibrium,  the  principle  of 
virtual  work  states  that  the  virtual  work  (6W)  must  be  zero, 
or 

6W  =  Tq   •   6q  +  iT"   •   6^u  (2_123) 

=   (5q)T  Ta  +   .2     (6iu)T  ^ 
1=1         —  — 

=   (6q)T  Ta  +   ,E      (  (SqJ^iG^T)1^ 
M       1=1  q  ~ 

=   (dq)7^  +    ,E      [iGu]  i-Tu} 
~ M       1=1         q  — 

=  0 


57 

since,  for  the  virtual  displacements  (e1^)  to  be  compatible 
with  the  system  constraints  (see  equations  (2-7)  and  (2-8)) 

M  i 

61u  =     E       3  u  6qn  =  [1Gu]6q 

n=1     3c*n  q  (2-124) 

Now,  because  the  virtual  generalized  displacements  (6qn)  are 

all  independent,  hence  arbitrary,  equation  (2-123)  yields  M 

independent  equations  for  the  required  generalized  loads  as, 

in  vector  form 

TCT  =  [iGu]T         =  -TL 

H      1=1      q  ~q  (2-125) 

where        is  the  effective  load  at  the  inputs  due  to  all 
applied  loads. 


The  Generalized  Principle  of  D'Alembert 

The  statement  of  this  principle  is  as  follows:  the  total 
virtual  work  performed  by  the  applied  and  inertial  forces 
through  infinitesimal  virtual  displacements,  compatible  with 
the  system  constraints,  is  zero.     To  see  how  this  principle 
can  be  used  to  obtain  the  generalized  input  loads  (Tg) 
required  to  overcome  the  system's  inertia  and  cause  the 
desired  motion,  again  consider  the  dependent  parameters  (^u) 
of  equation  (2-119)  where,  now,  they  describe  the  kinematics 
of  the  system's  mass  parameters 

[XMU]  =  P  x  P  ,  i=l,2,...,N  (2-126) 
This  allows  the  system's  momentum  (Lu)   (both  linear  and 
angular)  to  be  expressed  by  the  N,  P-dimensional ,  vectors 
l1!,")  as 
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N  N 
Lu  =     2     (iLu,   =    Lz     ([iMU]iu)  (2-127) 

~       i=l      -  i=l 

Further,  assume  that  there  exist  N,  P-dimensional ,  load 
vectors  (^-T11,  i  =  l,2,...,n)  that  if  applied  to  the 
associated  mass  motion  parameters  would  cause  the 

desired  system  kinematics  (i.e.,  the  position,  velocity  and 
acceleration  of  the  Hi) .  The  generalized  principle  can  now 
be  written  as 

E     (LTn  -  ^)    ■  d1]!  -    E  (^  -  d_(  [iM11]1^)  )  -S1^  =  0 
1-1  1-1  dt  (2-128) 

yielding,  for  the  virtual  work  (5W)  done  by  these 
hypothetical  applied  loads  ( -i-Tu ) ,  the  following  relationship: 

6W  =    E    iTu  •  b^M  =    E      d([iMuJiu)   •  d^u 
i=l    -         ~     i=l  ~5t 

(2-129) 

This  result,  in  itself,  is  not  very  useful  since  the  virtual 
displacements  (S^u,  i  =  1,2,. ..,n)  are  not  independent. 
However,  when  one  recognizes  that  the  virtual  work  can  also 
be  expressed  in  terms  of  a  set  of  M  generalized  forces  (Tq) 
acting  on  a  corresponding  set  of  generalized  coordinates 
(gj,  which  are  independent,  as  (where  here  the  generalized 
forces  are,  in  essence,  replacing  the  hypothetical  applied 
loads  instead  of  opposing  them,  as  in  equation  (2-125)  to 
obtain  static  equilibrium) 

6W  =  iT"   •   6^u  =  Tq   •   6q  (2_130) 


the  following,  very  powerful,  result  occurs: 
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la  '  62  =    5    _d( [ 1MU ] ^u)  •  6xa 
1               x~l  dt 

N  (2-131) 

=     Z       dU^-M^u)  •  [1GU]62 
i=1  dt              "  q 

or,  following  manipulations  similar  to  equations  (2-123), 

the  required  generalized  forces  are 

Ta  =     E     [LGn]T  {  d([iMu]iu)} 

at  (2-132) 

Investigation  of  equation  (2-132)  yields  an  interesting 

result.  That  is,  the  effect  of  the  dynamics  of  each  mass 

motion  parameter  (e.g.,  each  link)  on  the  generalized  inputs 

can  be  considered  independently  (also  see  Silver,  1982, 

equation  (25),  where  the  dynamics  of  each  link  are  expressed 

in  terms  of  the  Newton-Euler  equations).     In  fact,  the 

result  of  equation  (2-132)  can  be  obtained  from  the 

derivation  of  the  generalized  input  loads  required  to  offset 

a  set  of  applied  loads  (see  equations  (2-123),   (2-124)  and 

(2-125)).     To  see  this,  simply  replace  the  applied  loads 

( 1TU)  in  these  equations  with  either  the  d'Alembert  loads 

( ( [iMu]iu)  )  or  the  negative  of  the  Newton-Euler 
dt 

equations.     In  this  light,  one  could  view  the  result  of 
equation  (2-132)  as  being  obtained  from  the  virtual  work  of 
the  d'Alembert  loads. 

Now,  recalling  equation  (2-7)  for  (1u),  equation  (2-132) 
can  be  written  as 

Tq  =   . E     [iGuJT  {_d( [iMu][iGu]2)} 

1-1        q        dt  <3  (2-133) 
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Recognizing  that  the  momentum  vectors  are  functions  of  the 
generalized  coordinate  positions  and  velocities  (i.e.,  q  and 
q) ,  one  has  that 

d(  [W  [^Jq)   =  J_(  [WH^l^a  +    3(  [iMu][iGu]q)q 
dt  5  3q  q  3q  q  (2-134) 

The  second  of  these  terms  follows  immediately  from  equation 
(2-13)  as 

3  ([iMU][iGu]2)q  =  [Wt^Jq  (2-135) 

q  q 

If  the  mass  parameters  ([-^M11])  are  configuration  independent 
(i.e.,   [XMU]  =  f(q))   (which  is  not  the  case  when  dealing 
with  the  effects  of  inertia  in  spatial  devices,  but 
including  the  generalization  gives  no  insight  here  and  the 
question  will  be  dealt  with  specifically  in  the  case  of  the 
serial  manipulator),  then  recalling  the  development  of 
equations  (2-14)  through  (2-24),  the  first  term  of  equation 
(2-134)  becomes 

_3  (  i^}  [iGu]q)q  =   [iMa]qT[iHxl   ]q  (2-136) 

3q  q  ~qq~ 

Substituting  the  results  of  equations  (2-135)  and  (2-136) 


into  equation  (2-13  3)  gives    for  the  required  input  loads 

Tq  =  E  {[iG^T^H^nq 
~         1=1  q  q  ~ 


(2-137) 


+   .2     {[iGuJTtiMu]qT[iHu  ]q} 
1=1  q  ~        qq  " 


Note  that  for  constant  mass  ([^-M11]),  this  equation  can  be 

immediately  obtained  by  substituting  equation  (2-27)  for 

(^-u)  into  equation  (2-132).     Now,  equation  (2-137)  can  be 

written  in  the  general  form  for  the  generalized  inertia 

loads  (T1)  as 
-q 
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T1  =  [I*  ]q  +  qT[P*  ]q  (2-138) 
-q  qq  -      -      qqq  - 

where,  the  configuration  dependent  coefficient 

[I*  ]  =  .S     [^j"^^]^11]  =  M  x  M 

qq         1=1         q  q  (2-139) 

is  a  positive  definate  matrix  representing  the  effective 
inertia  of  the  system  as  seen  by  the  inputs.     The  system's 
kinetic  energy  is  also  expressable  in  terms  of  this 
coefficient  (see  Thomas,  1981)  as 

The  configuration  dependent  coefficient 

[P*      ]   =    .S     (  (  [^^[iM11]  )    •    [iHu   ])   =  M  X  M  X  M1 
qqq         1=1  q  qq 

(2-141) 

is  the  inertia-power  modeling  matrix  dealing  with  the 
effects  of  the  velocity-related  acceleration  terms.  Note 
that  the  subscripts  on  the  model  coefficients  indicate,  not 
only  the  dimension  of  the  result,  but  also  aid  in 
investigating  specific  terms.     For  example,  the  ntn 
generalized  inertia  load  is 


T*  =   [I*    ]q  +  q'T[P*  ]q 
n  nq  -      -      nqq  -  (2-142) 


=   [I*    ]     q  +  qT[P*      ]  q 
qq  n ; ~       ~      qqq  n ; ; ~ 


where 


62 


[I*  J 
nq 


i=l        n  q 


.  E     [^jTf  [*-Gu] 


(2-143) 


and 


nqq 


(2-144) 


It  should  be  noted  that  the  form  given  in  equation 
(2-138)  for  the  inertia  related  terms  of  the  dynamic  model 
is  completely  general  and  applies  to  all  types  of  rigid-link 
mechanisms.     The  only  differences  lie  in  how  the  kinematic 
influence  coefficients  are  obtained  and,  if  the  mass 
parameters  (  [ ^-Mu ] )  are  configuration  dependent,  the 
coefficient  [P      ]  contains  an  additional  term  (as  will  be 


seen  in  the  serial  manipulator  development). 

The  Dynamic  Equations 

Finally,  recalling  equations  (2-125)  and  (2-138),  the 
generalized  input  forces  (or  torques)  required  to  generate 
the  desired  system  trajectory  under  load  are  given  by 


This  result  shows  the  highly  geometric  nature  of  the 
dynamics  of  multi-body  systems,  and  is  precisely  the  reason 
why  this  representation  for  the  dynamic  model  is  chosen  over 
the  Newton-Euler  form.     While  this  form  may,  or  may  not, 
immediately  yield  the  most  efficient  scheme  for  real-time 


nqq 


-  T 


L 

q 


(2-145) 


63 

computation  (Hollerbach,  1980),  the  insight  that  can  be 
obtained  from  this  geometric  view  is  considered  essential 
for  real-time  control.  What  is  meant  by  this  is  that,  if 
one  does  not  understand  the  essence  (which  is  geometric)  of 
how  the  effects  of  the  system  parameters  (e.g.,  system  mass, 
end-effector  loads)  on  the  inputs  vary,  then  it  is  unlikely 
that  one  can  intelligently  address  the  guestion  of  any  type 
of  control,  much  less  real-time  control.  Regardless,  as 
will  be  seen  later,  when  dealing  with  cooperating 
manipulators  (including  walking  machines  and  multi-fingered 
hands)  the  geometric  form  of  eguation  (2-145)  is  extremely 
useful,  if  not  altogether  essential. 

This  form  (eguation  (2-145))  is  also  convenient  in 
addressing  the  guestion  of  dynamic  simulation.     Here,  since 
the  effective  inertia  matrix  ([I*  ])  is  positive  definite 

qq 

(i.e.,  its  inverse  always  exists), one  can  determine  the 
system's  response  by  solving  eguation  (2-145)  for  the 
generalized  accelerations  as 

q  =  [I*   ]~1(TQ  -  qT[P*     ]q  +     2   [*GU]T  W 

qq  q       "       qqq  -       1=1  "  (2_14fi) 

While  any  of  a  number  of  numerical  integration  routines  can 
be  employed  to  solve  this  equation,  multi-step 
predictor-corrector  methods  (e.g.,  Adams)  are  suggested  over 
single-step  methods  (e.g.,  Runge-Kutta)  due  to  their  greater 
efficiency  regarding  compute-time  versus  accuracy.  This 
greater  efficiency  is  desired  because  of  the  computational 


complexity  of  the  function  evaluations  required  at  each  time 
step.     It  should  be  pointed  out,  however,  that  the  effective 
inertia  matrix  is  the  only  model  coefficient  necessary  for 
the  response  prediction.     The  remaining  terms  are  perhaps 
best  obtained  in  terms  of  a  recursive  formulation  due  to  the 
supposed  greater  computational  efficiency  afforded  by  that 
method  (Walker  and  Orin,  1982). 

Also,  the  influence  coefficient  model  formulation  allows 
one  to  directly  address  the  question  of  design  (Thomas, 
1981).  Here,  the  model  parameters  can  be  used  in  conjunction 
with  classical  optimization  techniques  to  develop  actuator 
sizing  (Thomas  et  al.,  1984)  and  stiffness  (Thomas  et  al., 
1985)  criteria,  as  well  as  motion  and  load  capacity  due  to 
actuator  limitations  (Thomas  and  Tesar,  1982a). 

Dynamics  of  Serial  Manipulators 

The  development  of  the  dynamic  equations  presented  here 
will  follow  the  structure  of  the  previous  parts  of  this 
section.  First,  the  effect  of  applied  loads  on  the 
manipulator's  generalized  inputs  (eg)  will  be  addressed  using 
the  principle  of  virtual  work.     Next,  the  systems  inertial 
effects  will  be  considered  via  the  generalized  principle  of 
d'Alembert.     Finally,  the  resulting  dynamic  equations  are 
presented  in  the  form  of  the  generalized  dynamic  model  of 
equation  ( 2-145 ) . 
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Applied  loads 

As  with  the  kinematics,  it  is  convenient  to  separate  the 
rotational  and  translational  properties  when  dealing  with 
the  dynamics  of  rigid  bodies  undergoing  spatial  motion.  In 
this  light,  consider  a  set  of  M,  3-component,  force  vectors 
(3fP,  j  =  1,2,...,M)  and  a  set  of  M,  3-component,  moment 
vectors  (m^k,  j  =  1,2, — ,M)  applied  to  their  respective 
translational  ( ^P)  and  rotational  motion  parameters. 

Now,  immediately  from  the  virtual  work  result  of  equation 
(2-125),  the  effect  of  the  applied  loads  on  the  generalized 
input  coordinates  (cp)  is  given  by 

TL  =    E     {pGp]T  1fp  +  [G^jT  m^} 
cp      ]=1  cp  cp  - 

(2-147) 

where,  the  Jacobians  are  both  3xM  matrices  defined  in 
equations  (2-66)  and  (2-55). 


Inertial  effects 

To  address  the  effects  of  the  system  inertia  one  could, 
as  previously  implied,  simply  apply  the  principle  of  virtual 
work  to  the  classical  Newton-Euler  equations  of  motion  for  a 
rigid  body,  yielding 

M 

T1  =     E     {pGcjT  0k  jac 

-cp       j  =  l     L   V  ~  (2-148) 

+  [GJk]T(  [iiiikj        +  ^jk  x  [iijkj^jk)} 

Here,  M^k  and  [II^k]  are,  respectively,  the  mass  and  global 
inertia  matrix  of  link  jk,  with 
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being  the  acceleration  of 
(3c),  and 

jk  _ 

and 

gJk  = 

are  the  absolute  angular  velocity  and  acceleration  of  link 
jk.  Now,  by  substituting  equations  (2-149),    (2-150)  and 
(2-151)  into  equation  (2-148)  and  algebraically  manipulating 
the  result  one  could  obtain  the  desired  general  form  of 
equation  (2-138).     While  this  operation  gives  the  desired 
result  it  is  felt  that  a  slightly  more  rigorous  approach, 
starting  with  the  system  momentum,  gives  more  insight  into 
the  geometric  nature  of  the  solution. 

The  momentum  of  a  rigid  body  (e.g.,  link  jk)  can  be 
expressed  in  terms  of  two  distinct  vector  quantities;  these 
being  the  linear  momentum  (P^)  expressed  in  terms  of  the 
mass  (M^)  and  the  velocity  (^Vc)  of  the  center  of  mass 
(^c),  and  the  angular  momentum  (L^)  given  in  terms  of  the 
link's  angular  velocity  (u_J^)  an(j  t^e  global  inertia  tensor 
([Il^k])  about  the  centroid  of  the  link. 

The  effective  generalized  inertia  loads  resulting  from 
the  rate  of  change  of  the  system's  linear  momentum  can  be 
obtained  directly  from  the  development  of  equations  (2-133) 


[jQc]cp  +  <pTpHc  ]6  (2-149) 
cp  -      ~        (pep  - 

the  center  of  mass  of  link  jk 


[Gjkl£  (2-150) 


[G^Vi  +  q,T[H3k]£  (2-151) 


through  (2-141).     This  is  possible  since  the  link's  mass 
(M^k)  is  constant  with  respect  to  the  global  reference 
(i.e.,  independent  of  the  system's  configuration)  and  can  be 
expressed  as 

[W   =  M3k[I]3x3  (2_152) 
which  allows  one  to  write  the  link's  linear  momentum  as 

pjk  =  H3k[3S=]2  (2.153) 

The  time  rate  of  change  is  now 

i>jk  =  Mjk(  {  jGc^  +  ATt  jHc 

cp  <?<P  -  (2-154) 


and  yields 


M 

PT1  =     E      pGc|T  P^k 
~<P       j  =  l         cp  ~ 


(2-155) 


as  the  total  effective  load  due  to  changing  linear  momentum. 
Expressing  equation  (2-155)  in  model  form  gives  the  load  as 

*T?  =  [PI*   ]C£  +  ^TtPp*  ]k 

CP  CPCP  CpCpCP  l^-lDDj 


with 

LPI*   ]   =    .2,    [PI^k]   =    ,E     (M^[jGc]T[3Gc])   =  M  x  M 

CPq?  3=1  CpCp  1=1  CP  CP 

(2-157) 

and 

[PP1J   =  J,    [Ppjk   1   =  H3k<[jGC1T  .   [jHC   J)   =  3  x  M  x  M 

cpcpcp        3=1        cpcpcp        ]=1  cp  cpcp 

(2-158) 
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c 

where  the  Jacobians  ( pG^] )  have  shape  (3xM)  and  the 
second-order  coefficients  ([^H^])  have  shape  (3xMxM). 

The  development  of  the  effective  inertia  loads  (^T^) 
caused  by  changes  in  the  system's  generalized  angular 
momentum  is  more  difficult.     This  is  due  to  the  fact  that, 
while  the  local  inertial  properties  {[^^11^])  of  link  jk 
are  constant,  the  inertia  properties  ([II^J)  expressed  in 
terms  of  the  global  reference  are  not.     As  previously 
mentioned,  this  configuration  dependence,  resulting  from  the 
rate  of  change  of  the  local  reference  frame  in  which  the 
link's  constant  local  inertia  matrix  is  expressed, 


introduces  an  additional  term  into  the  inertial  power  matrix 
* 


(  [  kPfnrnm  ]  )  . 


With  this  in  mind,  it  is  perhaps  best  to  initially  view 
the  global  angular  momentum  of  link  jk  (lJk)  in  terms  of  the 
link's  angular  momentum  as  expressed  in  its  own  body-fixed 
reference  ((^L^k).     Recalling  the  use  of  the  rotation 
matrix  (T^ )  illustrated  by  equations  (2-47)  and  (2-58),  one 
has 

L,jk  -  Tj  (  j  )^jk  (2-159) 
Now,  the  local  angular  momentum  is 

(j)L3k  =  [(j)njk](j)yjk  (2-160) 
where,  noting  that  the  rotation  matrix  is  orthogonal  (i.e., 
[TO]T  =  [TJ]"1),  the  link's  locally  expressed  angular 
velocity  is 

(j)ojjk  =   [Tj  jT^jk  =   [Tj]T[G^](p  (2-161) 

(0  — 
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Combining  equations  (2-159),   (2-160)  and  (2-161)  gives  the 
globally  referenced  angular  momentum  of  link  jk  as 

rJ*  =  [TJ][<3>IlJ*][T3]T[GJ*]i 

Cp  (2-162) 


This  is  the  desired  form  of  the  momentum  since  all 
configuration  dependent  terms  are  shown  explicitly.  Even 
so,  notice  that  the  global  angular  momentum  of  link  jk  (L^k) 
can  be  expressed  in  the  same  form  as  the  local  momentum 
(equation  2-160)  as 

r,jk  =  [iijkjwjk  =  [njk][Gjk]A  (2-163) 

where,  from  equation  (2-162) 

[IlJk]   =   [T^][(j)lI^][Tj]T  (2-164) 
is  the  globally  referenced  inertia  dyadic. 

As  before,  the  momentum  is  seen  to  be  a  function  of  the 
generalized  coordinate  positions  (cp)  and  velocities  (cp_) . 
Therefore,  the  time  rate  of  change  of  link  jk's  angular 
momentum  can  be  obtained  from 


Pep               9cp  (2-165) 

The  second  term  in  equation  (2-165)  is  immediately  seen  to 
be 

jk 

3L  <£  =  [II^HGikj  eg  (2-166) 
3cp  <P 
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The  position  derivative  is  not  as  transparent  and  will  be 
pursued  in  terms  of  the  standard  Jacobian  formulation  for 
vector  differentials.  Although  there  are  three 
configuration  dependent  terms  in  the  momentum  expression, 
the  differentiation  will  only  be  broken  into  two  separate 
operations  and  addressed  in  the  manner  of  Thomas  (1981). 
This  method  gives,  for  the  position  derivative 

3Ljk  =  J_(  [Iljkjujkj 
3  co  3(p_ 

=  j.([nJk][ajk]4)  (2-167) 

3(0  * 

=    3(Tj)  [(^II^kJ[T3]T[Gjkj^ 
3(0 

+  [T3]T[(j)IIjk]_3([TjjT[Gjk]^) 

3(0  <P 

To  obtain  the  first  partial  in  eguation  (2-167)  it  is 
beneficial  to  remember  what  the  elements  are  that  make  up 
the  columns  of  the  rotation  matrix: 

T j  =  [*a_1k  *sj  xV)k  Vh  (2-168) 

Here,  one  sees  that  the  vectors  whose  direction  cosines  make 
up  the  columns  of  (T^)  are  free  vectors  fixed  relative  to 
(i.e.,  in)  link  jk.     In  this  light,  recalling  the  more 
geometric  formulation  of  the  kinematic  influence 
coefficients,  the  differentiation  yields  the  familiar  vector 
cross  product  result 


3(T3)  =  g^k  x        ,  n=l,2, . .  .  , 


3cpn  _n 


M  (2-169) 


Defining  the  remainder  of  the  first  term  of  equation 
(2-167),  for  convenience,  as 

b  =  [(j)njkj[TjjT[Gjk](i) 

<p      —  (2-170) 

and  observing  the  Jacobian  convention,  gives  the  n*-*1  column 
of  the  first  partial  in  equation  (2-167)  as 


3( [T1 ]b) 


3cp 


=  3( [TJ Jb)  =  g^k  x  [T^]b 
;n  3<Pn  n  (2-171) 


where,  the  vector  (bj  is  considered  constant  in  this 
operation  as  indicated  by  the  bar  overstrike  (b) . 
Introducing  a  generalized  cross  product  notation  (x)  one  has 

[Gjk]T  x  Tjb  =  [gjk  x  Tjb  I  ...  !  gjk  x  Tjb] 
(P  _  1  -  1  '  3M 

(2-172) 

where  the  first  dimension  (i.e.,  row)  of  the  left  argument 
operates  across  the  first  dimension  of  the  right  argument 
(i.e.,  across  all  rows).     Now,  recalling  equations  (2-164) 
and  (2-170),  equation  (2-172)  gives,  for  the  first  partial 
in  equation  (2-167),  the  relationship 

81ri).[(j)lljk][Tj]T[Gjk]^  =  [GjkjT  x  [njk][Gjkii 
3cp  cp  cp  cp 

(2-173) 

Turning  our  attention  to  the  second  partial  in  equation 
(2-167),  the  first  step  (Thomas,  1981)  is  to  recognize  that 
since  the  rotation  matrix  (T^)  is  orthogonal,  i.e., 
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T^[T3]T  =  [I]3x3  =  constant,  (2-174) 

one  has  that 

_3(T:![t3  jTtG^jcp)   =  _9_(  [G^j^) 

8<P  9  3(£      ^  (2-175) 

Using  the  chain  rule  on  the  left-hand  side  of  equation 
(2-175),  and  referring  to  equations  (2-20)  and  (2-173), 
yields 

[G^]T  x  [Gjkj£  +  T^J.([T^]TiG^k]({))   =  cpT[Hjk]T 
*  *  9<£  CP  cp<p 

(2-176) 

Rearranging  and  premultiplying  by  [T^jT  gives 

_3([T3]T[Gjk3^  =  [T3  3T(^T[Hjk3T  _  fGjk]T  x  [Qjk](i)) 
Sep  <P  epep  "  cp  cp 

(2-177) 

Direct  investigation  of  the  right-hand  side  of  equation 
(2-177)  shows  that 

5PT[H^]T  -   [GjkjT  x  [Gjk]6  =  AT^jkn 
W  <P  cp  L  epep 

(2-178) 

Confirmation  of  the  above  result  is  left  to  the  reader; 
however  there  is  another  way  to  show  the  validity  of  the 
final  result  which  also  points  out  an  interesting  result. 
Considering  that  the  partial  derivative  of  equation  (2-177) 
is  to  be  postmultiplied  by  cp,  the  ultimate  usage  of  the 
relationship  given  by  equation  (2-178)  can  be  justified  by 
showing  that 

(  [G3k]T  x  [Gjkj£)(i)  =  0 

cp  cp    *  ~      -  (2-179) 
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since 


<pT[H3k]Tcp  =  (PT[H^k]c£  {?  lf?m 

cpcp    ~~      —      cpcp  v^-iouj 


Recalling  equations  (2-55)  and  (2-172),  and  manipulating 
the  result,  one  has  the  following: 

([G3k]T  x  [Gjk]c£)cp  =  ([G^]  x  a^k)cp 

cp  cp  cp  (2-181) 


=  [2jk  x  ^k     ...     g^K  x  J*]* 


=    E  (g^kcp  )  x 
n=l    n  n 

=  cJk  x  <^k 

=  UG^lcp)  x  ([G^jcg) 
cp  cp 

=  0 

Therefore,  while  not  rigorously  verifying  equation  (2-178), 
the  preceding  proves  that 

J_([Ti}TlGi*}&&  =  [T3]T(^T[Hjk](i)) 
9<p  <P  cpcp  ~ 

-  (2-182) 

which  is  the  term  ultimately  needed.     Finally,  by 
substituting  equations  (2-166),    (2-173)  and  (2-182)  into 
equation  (2-165)  and,  recalling  equation  (2-164),  the  time 
rate  of  change  of  the  angular  momentum  of  link  jk  can  be 
expressed  as 

Ljk  =  [njkj^jkj^  +  [iIjk]^T[Hjk]^ 

cpcp  (2-183) 

+   (  [G3k]T  x  [njkjfgjkjAjA 

CP  CO 
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Note  that,  by  combining  the  first  two  terms  of  equation 
(2-183)  and  following  the  algebra  of  equation  (2-181), 
equation  (2-183)  is  an  alternate  form  of  Euler's  equation  of 
motion  for  a  rigid  body  as  expressed  in  the  global  reference 
N  =  L^k  =  [Il^ja^  +  wJk  x  [II  jkjaJ*  (2-184) 
Now,  referring  to  either  equation  (2-132)  or  (2-148),  to 
obtain  the  generalized  load  required  for  this  change  in 
momentum  (LT*)  one  premultiplies  equation  (2-183)  by  the 
transpose  of  the  link's  first  order  rotational  influence 
coefficient  ( [G^k JT) ,  yielding 


^T1  =     £     [G^TlJk  =     E  {[Gjk]T[Ii:k][G^]cp 
-<p       ]=1       cp      ~  j=l         cp  cp  - 

(2-185) 

cp  cpcp  JL 

+   [G^]T([GjkjT  x   [Gjkj    }  } 
cp  cp  cp 

To  get  this  equation  into  the  desired  form  of  equation 
(2-138)  requires  some  manipulation  of  the  velocity  related 
terms.     The  first  of  these  terms  is  readily  accommodated  by 
the  generalized  dot  product  (see  Appendix  A)  giving 

[G3k]T[IIjk]^T[Hjkj  TtfQjkjTfujkj   .   [HjJcj  , 

<P  cpcp  ~        cp  cpcp  - 

(2-186) 

The  remaining  term  is  a  bit  more  obscure  and  is  attacked 

with  the  aid  of  the  following  vector  relationship: 

a«bxc  =  c«axb 

-      -  (2-187) 


5?  nV  M 
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Recalling 


L.Ik  -  [iijkj^jk]^ 


(2-188) 


one  has  that 


[G3kjT([GikjT  x  tiijJcJ[Gjkjij 
cp  cp  cp 


=   [G3kjT([GjkjT  x  Ljk, 


(2-189) 


=   [G^]T([    jk  x  Ljk  J  _ 
cp  "I  ~ 


!  ^k  x  LjkJ> 


ajk  •  sjk  x  L^k  . 


gjk    .    gjk    x  Ljk 

-M         -1  - 


. .  g^k  •  gik  x 

-1  2M 


.  g^k  •  g-ik  x  L3k 
-M  M 


ljk  .  gjk  x  jk 
*1  *l 


L3k  .  gjk  x  jk 
M  *1 


.   lJk  •  gjk  x  g^k 
*1  M 


lJk   •  gjk  x  g^k 


where 


=  (LJk)T[[G:kjT  x  [G^kJ] 
cp  cp 


C[GcikjT  X   lGlk]K       =  x   tGJkJ   =  3  x  M 

(o  cp       n;  ;       — n  cp 


(2-190) 


so 


[G3k]T([Gjk]T  x  [ujkjjQjkjiji 


0) 


CP 


(2-191) 


=  5PT([Gi.k]T[Iljk]([Gjk]T  x  tGjkjni 
cp  cp  cp 
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Now,  from  equations  (2-185),   (2-136)  and  (2-191),  one  has 

LTI     =   j-Lj*         +  ATfLp*  (2-192) 

CPCP  (p<p   ~  "  (pcpcp 

where 

LT*   ,         M  ,r._-iv.  M 


and 


C   Cj   =  sE1[LIjlC]   =    .2 1(CG3k]T[IIjJc][Gjk]) 
cpcp        3=1       cpcp        3  =  1       <p  cp 

(2-193) 

LLP*     ]  =   .2  [Lpjk  j  =    g     {[G^jTjujkj   .  [Hjk], 
epepep        3=1       epepep         3=1        cp  J       1  cpcpJ 

+  ([G^k]T[njk]([GjkjT  x  [GjkJ))} 
<P  cp  cp 

(2-194) 

Fmal±y,  combining  the  effects  of  both  the  linear  and 
angular  momentum  gives 

cp  epep  -      *      epepep  -  (2-195) 

for  the  total  generalized  inertia  load,  where 

[i*  j  =  [Pi*  j  +  [Lj*  j 

epep  epep  <pcp 

(2-196) 

M  _. 


.2  {M^[3GC]T[  jGCj  +  (Gjk]T[II3k][Gjk]} 
J-l  cp  cp  cp  <p 


and 


] 


[P*     ]  =  CPP*     ]  +  [LP*  ] 
epepep  epepep  epepep 

(2-197) 

=    .  E   {M^k(  pGcjT  •    [ jHc   ] ) 
]-l  cp  (pep 

+   ( tG^kjT[ii3kj    .    [Hjkj  j 
<P  epep 

+  ([G3k]T[IIjk]([G3kJT  x  [Gjk]))} 
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The  dynamic  equations 

The  dynamic  equations  for  the  general  M-degree  of 
freedom  serial  manipulator  can  now  be  written  in  the  desired 
general  form  of  equation  (2-145),  giving  the  required 
generalized  input  load  as 

Ice  =  CI*  I'i  +  cpTLP*     ](£  -    .8 aOq*]*  3fP  +  [G3k]Tmjk 
cpcp  cptpcp  1=1        <p        -  <p  - 

(2-198) 

with  the  I*  and  P*  matrices  as  defined  in  equations  (2-196) 
and  (2-197).     Solving  this  equation  for  the  generalized 
coordinate  accelerations  gives  the  simulation  form  of  the 
dynamic  equation 

CP  =  [I*  ]"1{TCD  -  £T[P*     ]<p  +  tl} 

<D<P  ^  cpcpcp  -      -<p  (2-199) 

used  to  predict  the  motion  of  the  manipulator  resulting  from 
the  load  state  on  the  system. 

This  completes  the  development  of  the  dynamic  model  for 
the  general  M-degree  of  freedom  serial  manipulator.     The  two 
second-order  equations  (2-198)  and  (2-199),  or  some  other 
representation  of  these  relationships,  are  the  usual 
stopping  points  in  the  study  of  the  motion  of  rigid-link 
mechanisms.  While  one  can  determine  the  input  loads  (T  ) 
(force  or  torque)  required  to  cause  a  specified  motion 
(cp(t)),  or  the  response  (<p(t))  of  the  system  to  the 
specified  load  state  (TQ) ,  the  question  of  control  is  not 
immediately  addressable.     The  reason  for  this  is  that  these 
equations  assume  the  instantaneous  availability  of  finite 
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torque.     This  availability  is  not  generally  the  case  since 
the  actuators  themselves  are  governed  by  their  own  dynamic 
equations.     In  an  effort  to  overcome  this  deficiency  the 
following  section,  cognizant  of  modern  linear  control 
theory,  is  included. 

The  Linearization  of  the  Dynamic  Model 

Many  researchers  (e.g.,  Kahn  and  Roth,  1971,  Dubowsky 
and  DesForges,  1979,  Horowitz  and  Tomizuka,  1980,  Liegeois 
et  al.,   1980,  Armada  and  No,  1981,  LeBorgne  et  al.,  1981, 
Go 11a  et  al.,  1981,  Freund,  1982,  Guez,  1982,  Vukobratovic 
and  Stokic,  1982a,  and  Stoten,  1983)  have  investigated  (and 
are  continuing  to  investigate)  various  methods  of  linear  and 
nonlinear,  adaptive  and  nonadaptive,  control.  While  it 
appears  likely  that  nonlinear  adaptive  control  schemes  hold 
the  greatest  promise  for  the  ultimate  real-time  control  of 
highly  nonlinear  systems  such  as  robotic  manipulators,  the 
development  of  such  a  scheme  is  not  the  purpose  of  this 
section.     The  purpose  of  this  section  is,  instead,  to  use 
the  well  established  technique  of  linearization  about  a 
nominal  motion  trajectory,  to  develop  a  generalized  state 
space  model.     Once  this  model  is  established,  while  again 
not  the  purpose  here,  one  can  apply  the  tremendous  body  of 
knowledge  of  modern  control  theory  to  address  the 
feasibility  of  such  control  methods.     Here,  of  primary 
concern  would  be  the  question  of  the  time  variance  of  the 
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coefficients  in  the  state  space  model.     In  other  words,  for 
a  given  task  (or  trajectory),  do  the  coefficients  vary 
slowly  enough  to  allow  the  system  to  be  treated  as  time 
invariant  with  respect  to  controller  design?    While  this 
type  of  formulation  is  not  original  ( see  Vukobratovic  and 
Kircanski,  1982b,  Lee  and  Lee,  1984,  and  Whitehead,  1984), 
it  does  not  appear  to  have  been  fully  investigated. 
Therefore,  for  possible  future  investigation  (for  specific 
short-term  solutions)  and  completeness,  this  section 
presents  the  development  of  the  generalized  controlling 
state  space  equations  for  the  serial  manipulator,  including 
actuator  dynamics. 

The  Linearized  Equations  of  Motion 

The  first  step  in  the  development  of  the  controlling 
state  space  equations  is  the  linearization  of  the  dynamic 
equations  with  respect  to  the  prescribed  state  variables 
(ignoring,  for  the  moment,  the  actuator  dynamics).  Here, 
adopting  the  standard  velocity-referenced  model,  the 
deviations  in  the  generalized  coordinate  positions  (6co)  and 
velocities  (6g>)  make  up  the  (2Mxl)  state  vector  (x) ,  or 


Now,  noting  that  the  generalized  load  (T^)  is  a  function  of 
the  generalized  positions  (<p)  ,  velocities  (q>)  and 
accelerations  ($) ,  one  has 
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3cp 


31  3T         „.  3T 


ocp        +  ~(P 

3cp 

cp  ( t )  nom . 


6cp        +  ~cp 

3cp 

cp  ( t )  nom . 


6£  (2-201) 
cp  ( t }  nom . 


as  the  general  equation  for  the  linearized  dynamics  (the 
question  of  independent  external  load  disturbance  is 
addressed  later).  The  task  at  hand,  then,  is  to  derive 
expressions  for  the  partial  derivatives  in  equation  (2-201), 
to  as  great  a  degree  as  possible,  in  terms  of  the  same 
general  algebraic  operations  and  parametric  modeling 
coefficients  employed  in  the  dynamic  equations  themselves 
(to  minimize  the  additional  computational  burden). 

Writing  the  generalized  load  in  the  form  of  equation 
(2-198)  gives 

=  [I*   ](p  +  <£T[p*     ]&  _     M  [jGujT  jTu 
~^  <p<p  ~~  cpcpcp  —      1=1      cp  — 

(2-202) 

where  (^Tu)  is  a  general  applied  load  vector  associated  with 
link  jk  consisting  of  both  force  and  moment  components  (and 
is  assumed  to  be  constant  in  the  following  derivations). 
This  form  allows  one  to  obtain  the  first  two  terms  in 
equation  (2-201)  directly  from  previous  operations. 
Recognizing  the  similarity  in  the  form  of  equations  (2-27) 
and  (2-202)  and,  recalling  the  development  of  equations 
(2-28)  through  (2-36),  one  has  that 

3  T       ..  ^ 

cp  6cg  =  LI  ]6cp 

9  cp  <P<P  (2-203) 

and 
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3T 
3~cp 


~jp  6<i  =  cpT([P*     ]   +  LP*  ]T)6i 
—        cpcpcp  cpcpcp 


(2-204) 


Now,  to  address  the  third  term  of  equation  (2-201), 
particularly  in  light  of  the  previously  described 
generalized  vector  dot  (•)  and  cross  (x)  product  operations, 
it  is  convenient  to  express  the  dynamics  in  terms  of  the 
Newton-Euler  form  of  equations  (2-147),   (2-155)  and  (2-185) 


as 


j=l 


(2-205) 

Investigating  the  last  term  of  equation  (2-205),  where  the 
preceding  superscript  (j)  is  dropped,  one  has  the  standard 
Jacobian  result 


qU    .J.    u  rpu 

8(1  cp]  T  )   =   3(-cp)  = 


35£ 


3<£ 


9TL  3TL 


3*1  3*2 


3T^ 


3TJ 
1*M 


3*1 


3T^ 
M 

3«i 


3T1 


M 


3*M 


(2-206) 


This  gives  the  component  in  the  m*1*1  row  and  n1-*1  column  as 


3T 


m    =  3( (TU)T  •    (~m) )  =  (TU)T  •  h 


,u 


3«>n 


3<P 


u 

nm 


n 


(2-207) 


or,  for  the  total  MxM  matrix  result,  reintroducing  the 
superscript  (j),  one  obtains  the  expression 
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s([3g^]T  V  )  =  (3T«)T  .  [jH«  ]T       f2  Pnfn 

9(p  ~  (Pep  (^  ^08' 


The  contribution  of  the  linear  momentum  can  be  determined, 
using  the  chain  rule,  from 


3(fj°SiVk)  -  8([3GSlTi3fc)  ♦  [3GC]T  3^ 
3  cp  3  CP  *  g  co 


(2-209) 

The  first  term,  where  the  change  in  momentum  is  considered 
constant  (signified  by  the  bar  notation),  follows  directly 
from  the  previous  derivation  and  yields 


(2-210) 


9([3GS]Tl3k)   =  (P^,T  .   EjHc  j 
3cp  <D<P 

with  the  symmetry  in  the  translational  (h,H)  function 
observed.  Recalling  equation  (2-154),  one  has  that 


i  k 

3(1__L  =  M^k  _3 (  [  -^Gc  ]cp  +  £t[3hc  ]&) 

"aa  *     *  <*>-  (2_211) 

which,  referring  co  equation  (2-38)  and  (2-41),  becomes 

&(£3   )  =  M^k(c£T[3Hc   1   +  cpTpDc  ]A) 
3(P  W  cpcpcp 

-  (2-212) 

Now,  premultipling  equation  (2-212)  by  the  Jacobian 
transpose  and  substituting,  with  equation  (2-210),  the 
result  into  equation  (2-209)  gives 

3([  GSlVk)   =   (P^)T  .    tjHC  j 
3  cp  0)cp 
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Application  of  the  generalized  inner  product  to  the  second 
term  of  this  equation  yields 

ajk[jGc]T($T[jHc  ]}  =  XTdJjkfjQCjT  .   [jHc  ]) 
cp  (pep  cp  (p<p 

(2-214) 

which,  recalling  equation  (2-158),  gives  the  fortuitous 
result 

M^[]GC]T((PT[^HC  j)  =  (pTcPpjk  ] 

(P  epep  (pepep  (2-215) 

Finally,  substituting  equation  (2-215)  into  (2-213)  one 
obtains  the  expression 


3jJ     cp]  £J    )   =   (pHk)T  •   [DHC  1 
9  cp  W 

cp<p<p 


(2-216) 


+  M^[]GcJt((pt[3dc  ]&) 
cp  epepep 

Now,  recalling  the  result  of  equation  (2-208)  and  the  form 
of  equation  (2-209),  the  contribution  of  a  link's  angular 
momentum  to  the  last  term  in  equation  (2-201)  can  be  written 
immediately  as 

9([G^.k]Tj3k)     =  (L3k)T  .  [HDk]T  +  [GjkjT  ^ 

(2-217) 
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To  obtain  the  final  partial  derivative  it  is  perhaps  most 
convenient,  especially  considering  previous  derivations,  to 
use  Euler's  form  for  the  change  in  angular  momentum  (see 
equation* 2-184 )) ,  or 

3(L]k)  =  J_(  [II^k]a3k  +  ^jk  x  [njk^jk,  (2-218) 
9  cp          9  <p 

Addressing  the  first  term  one  has  (see  the  development 

presented  in  eguations  (2-167)  through  (2-177)) 

_S_(lIIjk]a^)  =  [G^kJT  x  [Il^jgJk 
9*  *  "  (2-219) 

+  fll3k](  -  [G^k]T  x  a^k) 

9<P  * 

Recalling  eguation  (2-70)  for  link  jk's  angular  acceleration 
and  the  form  of  equation  (2-43)  for  the  first  geometric 
derivative  of  the  acceleration    allows  one  to  rewrite 
equation  (2-219)  as 

9  (  [II^k]ajk)=  ([G^lT  x  [II^k]  (  [GJk]cp  +  pT[H^k]<i))) 
3cp  <P  cp  cpcp 

(2-220) 

+   [Il3k]{($T[H3k]T  +  <i)T[Djk  Jcp 

(P(P  (DCPCP  ~ 

-   [G3k]T  x  ([G3k]cp  +  <pT[H:ik]6)} 

CD  Cp      —        —        (p(p  — 

Utilizing  the  result  of  equation  (2-178),  equation 
(2-220)  can  be  reduced  slightly  to 

9  (  [II^k]a^k)  =  ([G^k]T  x  [  II^k  J  (  [G^k]c£  +  (p^[Hjk](p)) 
Taj  <f>  cp  <pcp  ~ 

(2-221) 

+   [II^k]($T[Hlk]   +  <pT[D1k   ]cp  -   [G^k]T  x  cpT[H^k]<p) 
(p<p  epepep  —  cp  ~      cpcp  ~ 
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Now,  returning  to  equation  (2-218),  one  has  that 

_l(<Jk  x  [II^]Jk)  =  _3_(.ajk  x  L^k)  (2-222) 
3cp  3co 

=   Zu3^  x  lJk  +  up k  x  3L^k 
3®  3£ 


Substituting  the  results  of  equations  (2-20)  and  (2-167), 
respectively,  for  the  partial  derivatives  in  equation 
(2-222)  give 

_3(  oPk  x  L^k)  =  (c£T[Hjk]T)  x  Ljk 

3^  W  (2-223) 

+  Jk  x  ([G3k]T  x  Ljk  +  (n.ik](<pT[Hjk])) 

cp  -  <pcp 

Combining  the  results  of  equations  (2-221)  and  (2-223)  to 
obtain  an  expression  for  equation  (2-218)  and  substituting 
this  expression  into  equation  (2-217)  yields,  in  light  of 
equation  (2-194)  and  the  generalized  vector  dot  (•)  and 
cross  (x)  products,  the  3xM  matrix 

3([G3kjTLjk)   =   (fJkjT  .  [Hjk]T 
3£      <P  cpcp 

(2-224) 

+  cpTfLpDk  j 
cpcpcp 

+   [Gjk]T{([G:kjT  x  ^T{illjk}    .  [njkjjA) 
cp  cp  cpcp  — 

+   (  (ci>T[H3k]T  x  [njk][Gjk]A) 
cpcp  CP  ~ 

+   (  (  [G^jcpJ1  x  (  LII^k](cpT[H^kJT) 
cp  cpcp 

+   [G^k]T  x  ( [II^k][G^k]6) ) ) 
cp  cp  ~ 
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+   [II^k](((iT[D^   ]<p  -   [G^k]T  X  ^T[H^Ji)} 
cpcpcp  ■  cp  (P(p 


Finally,  substituting  the  results  of  equations  (2-203), 
(2-204),   (2-208),   (2-216)  and  (2-224)  into  equation  (2-201) 
one  has  the  general  linearized  dynamics  given  by  (where  all 
coefficients  are  evaluated  at  the  nominal  generalized 
coordinate  values) 


Sly 


3T 


9* 


6cp  + 


3T 


4> 


3<£ 


6cp  + 


3T 


<P 


3<£ 


6cp_ 


(2-225) 


=  [I*   j6$  +  [<i>T([P*     ]   +   [P*      ]T)  J64> 
cpcp  cpcpcp  cp(p<p  — 


M 

+  [     S  {-(3TU)T  •   [^Hu   ]T  +   (P^k)T  •    [3HC  ]T 
3=1  cpcp  cpcp 

+  (L3k)T.  [H^k]T  +  pGc]T  3(p3k) 
<pcp  (0  ~ 

+   [G^]T  3(f,3k)}]  59 
*      3*  ~ 


Notice  that,  if  the  load  (3tu)  is  a  known  function  of  the 
generalized  coordinates,  the  effect  can  be  easily  accounted 
for.  For  example,  if  the  load  is  a  function  of  velocity  the 
second  term  in  equation  (2-201)  will  become 


3T 
9(p_ 


cp  6cp  =   [cpT([P*     ]   +   [P*     ]T)_     J  [jGu]T33TUT66 
cpcpcp  (pcpcp  j=l       CP         £  *  - 


(2-226) 

Also,  if  the  load  itself  varies  from  its  nominal  value, 
which  is  likely,  equation  (2-201)  contains  the  additional 
term 
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M       9T  M     4  „  T 

.2-   $     =  -,E   [^GU]T  6jTu 

]       9jTu  3=1       cp  (2-227) 

Investigation  of  equation  (2-225)  shows  that  no  new 
computations  are  required  for  the  first  two  coefficient 
matrices  however;  for  the  third  (i.e.,   [aT^/gcpJ)  there 
appears  to  be  a  considerable  additional  requirement.  In 
view  of  this,  especially  with  recognition  of  the 
considerable  similarity  in  the  basic  nature  of  the  various 
components  making  up  this  coefficient,  a  detailed 
investigation  of  this  matrix  to  determine  the  minimal 
reduced  equation  is  warranted.     However,  since  the 
linearized  model  coefficients  are  based  on  the  nominal 
trajectory  and  determined  off-line,  this  effort  is  left  for 
future  work. 


Actuator  Dynamics 

In  this  section  only  one  of  many  types  (e.g., 
electro-mechanical,  hydraulic,  pneumatic,  etc.)  of  actuators 
is  investigated.     For  additional  information  on  actuators 
and  their  dynamics  the  reader  is  referred  to  Borovac  et  al. 
(1983),  Electrocraft  (1978)  and  other  sources. 

The  specific  type  of  actuator  addressed  here  is  the 
separately  excited  d-c  motor  (Myklebust ,  1982).     In  this 
device,  the  field  current  is  held  constant  and  speed  control 
is  accomplished  by  control  of  the  armature  terminal  voltage. 
The  controlling  equations  for  this  type  of  device  are 
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Ldi  +  Ri  +  CEq  =  V  (2-228) 
dt 

Tg  +  Bq  -  CMi  =  -Tq 

for  a  single  actuator  or,  in  matrix  form,  for  all  M 
actuators 

£Lg]i  +  [RqU  +  ^Eg^S  =  1  (2-229) 

[Tq]q  +  [Bq]g  -  [CMq]i  =  -Tq 

where  i  is  the  Mxl  vector  of  armature  currents  (amp),  v  is 
the  Mxl  vector  of  terminal  voltage  (volt),  [Rq]  is  the  MxM 
diagonal  matrix  of  armature  resistances  (Ohm),  [Lq]  is  the 
MxM  diagonal  matrix  of  armature  inductances  (Henry),  g  is 
the  Mxl  vector  of  motor  output  shaft  angles  trad),  [Tq]  is 
the  constant  MxM  diagonal  matrix  of  rotor  inertias 
( in. -lbf-sec2 ) '   tBqj  is  the  MxM  diagonal  matrix  of  rotor 

damping  ( in. -lbf-sec ) ,   [CEq]  is  the  MxM  diagonal  matrix  of 
motor  speed  constants  (volt-sec),     [CMq]  is  the  MxM  diagonal 
matrix  of  motor  torgue  constants  ( in. -lbf /amp)  and  Tq  is  the 
Mxl  vector  of  load  torgues  (in. -lb*). 

Addressing  the  actuator  dynamics  one  must  relate  the  M 
output  shaft  parameters  (g)  to  the  M  generalized  joint 
coordinates  ((p)  •  Here,  the  following  assumptions  have  been 
made:  of  constant  transmission  between  the  motor  (gj  and 
joint  (g>)  parameters  (i.e.,  the  Jacobian  [G^J  is  constant), 

q 

zero  compliance  in  the  drive  train,  and  zero  backlash  in  the 
drive  train.     Recalling  eguations  (2-7),   (2-27)  and  (2-130) 
allows  one  to  write 
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(£  =  [G<«>]q 


q  ~ 


(2-230) 


M  =   [G<P]q   ,  [Gjg] 


=  constant 


q 


and 


(2-231) 


where  the  MxM  Jacobian  ( [G*] )  is  dependent  on  the  specific 
drive  trains  employed.     Here,  the  entry  in  row  m,  column  n 
relates  the  motion  of  the  mth  joint  parameter  (<pm)  to  the 
nth  motor  shaft  (qn).     Typically,  this  matrix  is  diagonal 
since  each  joint  is  usually  controlled  by  a  single 
associated  motor.     In  fact,  for  direct  drive  devices  this 
Jacobian  is  simply  the  MxM  identity  matrix.     At  any  rate, 
having  obtained  the  Jacobian  ([G^]),  and  recognizing  that  it 
is  the  joint  motion  (not  the  motor  shaft)  that  one  wishes  to 
control,  equation  (2-230)  is  used  to  find  the  desired 
relations 


Now,  substituting  equations  (2-231),  (2-232)  and  (  2-233.) 
into  equation  (2-229)  yields 


q  =  LG<0]-l<p 

q 


(2-232) 


and 


q  =  [G<P]"lcp 

-  q 


(2-233) 


[Lq]i  +   [Rq]i  +   [cEgj  [G^r^  =  V 


(2-234) 
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[IqHG^r^  +   [BqlCG'P]-1^  -   [CMqJi  =  -[6*]% 

for  the  motor  dynamics  expressed  in  terms  of  the  joint 
parameters.     Finally,  the  actuator  dynamics  (equation 
(2-232))  can  be  expressed  as 

[Lq]i  +   [Rq]i  +   [CE(p]&  =  V  (2-235) 

and 

-[Icpjcp  -   [B<p]&  +   [CM(p]i  =  (2-236) 
where  the  second  of  equations  (2-234)  was  premultiplied  by 
minus  the  inverse  transpose  of  the  Jacobian  and,  for 
example ,  where 

[T<p]    =  [G^J-TtlgjtG^]-1 

v         q       4     q  (2-237) 

One  should  note  that,  with  the  stated  assumptions,  ail  the 
coefficient  matrices  on  the  left-hand  side  of  equations 
(2-234)  and  (2-236)  are  independent  of  the  qeneralized 
coordinate  positions  (cp)  and,  since  the  variation  of  the 
motor  parameters  is  not  addressed,  are  considered  constant. 

Having  obtained  the  desired  expressions  for  the  actuator 
dynamics,  one  can  now  determine  the  nominal  input  voltages 
(V)  required  to  drive  the  system  along  the  specified  nominal 
trajectory  (cp_(t)).     Recalling  equation  (2-202)  and  solving 
equation  (2-236)  for  the  current  gives 

i  =  tCM(p]-1(Tcp  +  [B^J&J  (2-238) 
where  the  effective  rotor  inertia  ([1^])  has  been  included 
in  the  effective  inertia  matrix  ([ijL]).  Now, 


differentiating  equation  (2-238)  with  respect  to  time,  and 
recalling  equation  (2-225),  yields 


3T    ...      /  3T         .      ,\..       3T  . 

3$  \  3<£  /  32  (2-239) 

Finally,  assuming  that  the  nominal  joint  kinematics  are 

known  up  to  the  third  order  (i.e.,  g>(t),  <p(t),  cp(t)  and'g>(t) 

are  known),  equations  (2-238)  and  (2-239)  can  be  substituted 

into  equation  (2-235)  to  obtain  the  nominal  voltage  (V)  as 

^nominal  =  V(  cp  ,£,c£,'£)  nominal  (2-2  40) 

As  with  equation  (2-225)  for  the  linearized  generalized  load 

(65%),  equation  (2-240)  could  possible  be  reduced  to  a 

minimum  generic  form  of  the  class  of  equation  (2-145)  (T^). 

Again,  this  question  will  be  left  open  for  now  since  the 

immediate  usage  of  the  linearized  scheme  only  required 

off-line  computation  of  equation  (2-240). 

State  Space  Representation 

Having  incorporated  the  manipulator  dynamics  into  the 
describing  equations  for  the  actuator  dynamics,  and  having 
determined  the  nominal  input  (voltage)  requirements  one  can 
proceed  to  develop  the  state  space  model  of  the  system.  In 
the  case  of  the  d-c  motor  driven  manipulator,  the  state 
variables  are  chosen  to  be  the  deviations  in  the  generalized 
coordinate  positions  (6(g)  and  velocities  (6(g)  and  the 
deviation  in  motor  currents  (6i). 

With  this  selection  of  the  state  variables  the  state 
space  model  is  of  the  form 
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/  <Scp  1 

Fll  |_F12 

!  F13~ 

/c  \ 

~Gll" 

Sep 

F2l!_F22_ 

i  F23 

6g> 

+ 

\6ij 

_F31  1  F32 

!F33_ 

l6i/ 

G31 

6V 


(2-241) 


where  each  of  the  partition  matrices  (Fj_j,  G^j  )    is  MxM. 
These  matrices  are  determined  by  considering  the 
generalized  velocities  independent,  and  from  equations 
(2-235)  and  (2-236) .  First 

2  =  <E 

gives 

6<p  =  66 

so 

tFu]  =  [F13]  =  [GU]  =  [0] 

and 

[F12J  =  CI3mxM 
Next,  from  equation  (2-236) 

[CM(p]6i  =  6^  +  [T(p]6cp  +  [B^cp 
or,  recalling  equation  (2-225) 


(2-242) 


(2-243) 


(2-244) 


(2-245) 


(2-246) 


LCM(pj6i  =  [I*   ]6cp  +  [B^fW  +  f3-(pW 

w       \  m        J      \  9<p/ 

which,  when  solved  for  6cp,  yields 

9T 


(2-247) 


(2-248) 


i  9T 

CF22J   =  ~[1<nJ      (-^  +  [BCP]) 


cpcp 


[F23^  =  ^lj_1CCM(D] 


cpcp 


3i£ 
-M<p  ■ 
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and 


[G21]  =  [0] 


(2-249) 


Finally,  from  equation  (2-235) 


[Lq]6i  +   [Rg]6i  +   [CE(p]6<p  =  6V 


(2-250) 


which,  when  solved  for  6i,  gives 


[0] 


(2-251) 


and 


(2-252) 


where  the  inverse  of  the  constant  diagonal  matrix  [Lq]  is 
simply  the  diagonal  matrix  whose  entries  are  inverted. 

With  the  state  space  model  describing  the 
characteristics  of  the  system  about  some  nominal  trajectory 
fully  established,  the  questions  associated  with  controller 
design  can  now  be  addressed.  This  is,  again,  not  the  purpose 
here  and  the  reader  is  referred  to  the  extensive  work 
( Vukobratovic  and  Stokic,  1982a)  and  the  work  of  Whitehead 
(1984)  for  discretization  and  potential  controller 
development. 


Note 


^-The  dot  (•)  operator  will  prove  to  be  an  extremely 
powerful  tool  in  the  analyses  presented  throughout  this 
work,  and  hence,  will  be  dealt  with  in  an  appendix  for  easy 
reference.     It  is  a  generlized  inner  (or  dot)  product  and  is 
developed,  along  with  the  transition  from  equation  (2-137) 
to  equation  (2-141),  in  Appendix  A. 


CHAF  :er  III 


TRANSFER  OF  GENERALIZED  COORDINATES 


Consider  the  development  of  the  general  M-degree  of 
freedom  mechanism  presented   .n  Chapter  II.     Recalling,  in 
particular,  the  sections  dea _ing  with  the  generalized 
kinematics  and  dynamics,  one  sees  that  the  eguations  (Sg) 
describing  the  mechanics  of    such  devices  (e.g.,  equation 
(2-145)  for  the  generalized   .oad  Tq)  can  be  expressed  in 
terms  of  any  desired  set  (q  =  (q1#  q-^ ,  .  .  .  ,qM)T)  of 
generalized  coordinates  once  the  kinematic  influence 
coefficients  (relating  the  dependent  system  parameters  (u) 
to  that  particular  coordinate  set  (q) )  are  known.  Therefore, 
at  least  conceptually,  the  k.nematics,  dynamics  and  control 
of  these  systems  can  be  addr  essed  in  generic    form  from  any 
set  (q)  of  generalized  coord -nates  that  one  desires,  with 
the  only  difficulty  being  th  :  determination  of  the  required 
influence  coefficients.      Un  ortunately,  the  determination 
of  these  required  influence   roefficients  (directly)  in  terms 
of  the  desired  coordinates  (c)  may  be  (and  often  is) 
extremely  difficult  and  impractical,  if  not  altogether 
impossible.     Fortunately  how.ver,  most  (if  not  all) 
conceivable  mechanisms  can  bo  directly  modeled  (i.e.,  the 
influence  coefficients  can  be  directly  obtained)  from  at 
least  one  of  the  many  possib  e  sets  of  generalized 
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coordinates.     Now  considering  such  a  case,  what  one  would 
like  to  do  (see  Benedict  and  Tesar,1971  and  Freeman  and 
Tesar,  1982)  is,  first  obtain  the  system  model  (S^)  with 
respect  to  some  initial  set  of  coordinates  (eg)  for  which  the 
influence  coefficients  (including  those  relating  the  desired 
coordinates  (q)  to  the  initial  coordinates  (<f>)  )  are  easily 
determined  and  then,  use  this  information  (i.e.,  S^) ,  along 
with  the  coefficients  relating  (g)  to  (<p)  ,  to  determine  the 
desired  relationships  (Sq). 

To  illustrate  this  situation,  consider  the  general 
six-degree  of  freedom  serial  manipulator  (i.e.,  M  =  6) 
presented  in  Chapter  II.     Further,  suppose  that  one  desires 
to  consider  the  system  in  terms  of  six  generalized 
coordinates  (q)  associated  with  the  six  end-effector 
freedoms  since,  after  all,  it  is  the  hand  that  one  typically 
wishes  to  control.     For  all  but  the  simplest  of  systems, 
(e.g.,  partitionable  systems  such  as  those  treated  by  Paul 
et  al.,  1981a  and  1981b  and  Hollerbach  and  Sahar,  1983) 
where  the  inverse  kinematics  solution  is  readily  available, 
the  determination  of  the  describing  equations  (Sq)  directly 
in  terms  of  the  end-effector  coordinates  (q)  is,  at  best, 
extremely  complicated  ( I  know  of  no  such  solution  existing 
in  the  literature).  However,  as  shown  in  Chapter  II,  if  one 
investigates  the  serial  manipulator  in  terms  of  the  relative 
joint  angles  (eg)  ,  the  describing  equations  (Sq)  result  from 
simple  vector  operations  and  are  relatively  easy  to  obtain. 
Also,  since  the  end-effector  coordinates  (q)  can  be  viewed 
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as  simply  a  particular  set  of  dependent  system  parameters 
(u) ,  the  kinematic  influence  coefficients  relating  the  hand 
motion  (q)  to  the  relative  joint  angles  (eg)  are  readily 
available.  Finally,  as  will  be  shown  later,  the  initial 
model  information  (i.e.,  S^)  ,  along  with  the  known 
generalized  coordinate  relationships  (i.e.,   [G^]  and  higher 
order  coefficients),  can  be  used  in  a  straight  forward 
manner  to  determine  the  desired  description  (Sq)  of  the 
system  interactions. 

The  development  of  this  transfer  (i.e.,  S^Sg)  of 
generalized  coordinates  procedure  presented  in  this  chapter 
is  based  almost  entirely  on  the  principle  of  virtual  work 
and  the  previously  discussed  kinematic  influence  coefficient 
relationships  and  will  be  addressed  in  two  main  sections. 
The  first  deals  with  the  first-  and  second-order  kinematics 
and  dynamics  and,  the  second  deals,  briefly,  with  the 
third-order  kinematics  and  the  linearized  state  space  model. 
Also,  this  chapter  deals  solely  with  the  basic  analytical 
development  (all  the  components  of  which  have  already  been 
discussed)  and  leaves  the  more  interesting  possible 
applications  of  this  technology  for  the  next  chapter. 

While  the  treatment  presented  here  is  far  more  complete 
in  its  development  and  application  than  any  other 
investigation,  and  is  a  generalized  (and  logical)  extension 
of  the  one-degree  of  freedom  work  of  Benedict  and 
Tesar  (1971)  and  the  multi-degree  of  freedom  sequential 
transfer  of  Freeman  (1980),  the  basic  philosophy  involved  is 
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not  totally  unique  to  the  author  and  his  associates.  The 
basic  premise  is  widely  accepted  and  utilized  (particularly 
in  the  previously  described  case  of  the  serial  manipulator) 
throughout  the  community  in  numerous  forms ,  to  various 
extents,  and  with  differing  emphasis.     Specific  instances  of 
the  application  of  some  form  of  coordinate  transfer  with 
regards  to  control  (often  misleadingly  referred  to  in  the 
literature  as  decoupled  control)  include  the  resolved  motion 
rate  control  of  Whitney  (1969),  resolved  acceleration 
control  of  Luh  et  al.   (1980)  and  its  extension  to  the 
linearized  equations  of  motion  by  Lee  and  Lee  (1984),  the 
active  force  control  scheme  of  Hewit  and  Burdess  (1981),  the 
hybrid  control  approach  of  Raibert  and  Craig  (1981)  and, 
most  notably,  the  operational  space  work  of  Khatib  (1983) 
which  most  closely  parallels  the  work  presented  here  in  that 
it  deals  with  the  non-linear  second-order  geometric  transfer 
question.     Other  applications  dealing  more  directly  with 
system  design  than  with  control  include  the  actuator  load, 
motion  investigations  of  Thomas  and  Tesar  (1982a)  and,  the 
effective  inertia  ellipsoid  considerations  of  Assada  and 
Youcef-Toumi  (1983). 

The  Dynamic  Equations 

To  begin  the  development  of  the  transfer  of  generalized 
coordinates  concept  a  detailed  restatement  of  the  situation 
is  beneficial.     The  procedure  consists  of  four  steps  and  is 
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presented  in  terms  of  first-  and  second-order  system 
properties . 

First,  the  kinematic  influence  coefficients  (of  the 
dependent  system  parameters  (u) ) ,  and  hence,  the  dynamic 
model  (i.e.,  the  describing  equations  (Sq)  )  are  not  directly 
obtainable  with  respect  to  the  generalized  coordinates  (q). 
In  other  words,  one  desires  the  first-  and  second-order 
coefficients 


(3-1) 


q  31 


qq  9qaq 


and  the  ensuing  kinematics  (recall  equations  (2-7)  and 
(2-27)  ) 


U  =  [Gu]q 

q  - 

U  =   [Gu]q  +  qT[Hu  ]q 

q  ~         qq  _ 


and  dynamics  (recall  equation  (2-145)) 


(3-2) 


Tg  =  [I*  ]q  +  2.T[p*  14-  T§  (3-3) 
^  qq  qqq  U  J) 


but  cannot  obtain  them  directly  (i.e.,  they  are  unknown). 

Second,  the  describing  equations  (S^)  are  directly 
obtainable  with  respect  to  some  other,  initial,  set  of 
coordinates  (<p) .  This  means  that  the  kinematics 

u  =  [Gu]£ 

<P  (3-4) 
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U  =  [Gu]cp  +  £T[HU  ]<p 
<P  <P<P  ~ 


and  dynamics 


T<p  =  [I*  ]$  +  £T[P*     ](£  -  TL  (3_5) 


of  the  system  (related  to  the  set  (eg))  are  known  since,  the 
influence  coefficients 

[Gu]  =  an 

<P        32  (3-6) 

[Hu  j   =  92il 

and,  hence,  the  effective  model  parameters  (il^l)  and 
([p(pcp(p])  are  immediately  accessible. 

Third,  since  the  desired  generalized  coordinates  (q)  are 
also  known,  directly  obtainable  functions  of  the  initial 
coordinates  (eg),  the  kinematic  influence  coefficients 

[<*]  ~=  83 

2  (3_7) 
[H<3  ]  =    8  2 


cp<p 


8<g  3<p_ 


relating  the  desired  coordinates  (q)  to  the  initial 
coordinates  (cpj  are  available.     This  knowledge  allows  one  to 
express  the  desired  coordinate  velocities  (q)  and 
accelerations  (qj  as 


<P  ~  (3-8) 

and 


101 


q  =   [G<3]£  +  <i>T[H<3   ]<j>  (3-9) 
-         cp  -      -      cpcp  - 

and,  applying  the  principle  of  virtual  work  (recall  equation 
(2-130)),  the  (effective)  load  relationship  as 

T<p  =  LG^]TTq  (3-10) 

Finally,  with  the  relationships  given  by  equations 
(3-4),   (3-5),   (3-8),   (3-9)  and  (3-10),  one  has  all  the 
information  necessary  to  determine  the  desired  unknown 
parameters  in  equations  (3-2)  and  (3-3)  in  terms  of  the 
initial,  easily  obtained,  describing  equations  (S^).  The 
direct  kinematic  transfer  between  the  initial  (<g)  and 
desired  (q)  coordinates  (i.e.,  first-  and  second-order 
reverse  kinematics  solution)  is  also  available. 

Kinematic  Influence  Coefficients 

Here,  the  kinematic  relationships  of  equations  (3-2), 
(3-4),   (3-8)  and  (3-9)  are  used  to  obtain  the  desired 
influence  coefficients.     The  direct  transfer  between 
generalized  coordinates  is  addressed  first,  and  then,  the 
general  dependent  parameter  situation  is  considered. 
Direct  kinematic  transfer 

Consider  the  case  where  one  wishes  to  determine  the 
kinematics  of  the  initial  coordinates  (cp(t))  in  terms  of  the 
desired  coordinate  kinematics  (q(t)).     This  is,  in  fact,  the 
situation  in  the  resolved  rate  and  acceleration  control 
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schemes  of  Whitney  (1969)  and  Luh  et  al.  (1980), 
respectively,  where  the  desired  coordinates  (q)  are  the 
end-effector  motion  parameters,  and  the  initial  coordinates 
(<p)  are  the  relative  joint  angles  of  a  serial  manipulator. 
Recalling  the  general  form  of  equations  (3-2),  one  wants  to 
determine  the  coefficients 


[Oj]  ,  ||  (3_n) 

[H*   ]   =  d2<SL 
qq  3q3q 


required  (for  the  generalized  parametric  form)  to  evaluate 
the  initial  coordinate  velocities 


*  =    [Gq]i  (3-12) 


and  accelerations 

£  =   [G^jq  +  qT[H<P  ]q 

q  qq  -  0-13) 

This  information  (equation  (3-11))  is  not  directly 
available;  however,  the  reverse  relationships  of  equation 
(3-7)  are.  Therefore,  from  equation  (3-8),  one  has 

*  =  [G^rla  (3-i4, 

or,  comparing  with  equation  (3-12),  the  desired  first-order 
kinematic  influence  coefficient  is  found  to  be,  simply 

[G*]  =  [Qqj-i 

q  cp  (3-15) 
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Now,  recalling  equation  (3-9),  the  initial  coordinate  set 
acceleration  vector  (<£)  can  be  written  as 

£  =   [G<2]-lq  -   [G<2]-lci>T[Hq  ]<f>  „  lfi 

cp  (p       —       cpcp  (3-16 

Applying  the  generalized  scalar  product  (•)   (developed  in 
Appendix  A),  equation  (3-16)  becomes 

cp  =   [GSj-iq  -  ci>T([Gg]-l   .    [H<I   ]  )cj>  M  17 

cp  ~         cp  cpcp  (3-17 

or,  replacing  (eg)  by  equation  (3-14), 

cp  =   [G<J]-lq  -  qT[G<5]  ~T(  [G^] ~1  •    [H<2  JUG^-l^ 

cp  cp  cp  cpcp      cp  (3-18 

which,  when  compared  with  equation  (3-13),  yields 

[H<P   ]   =  -[Gc3j"T([G<J]-1   •   [H<3   ]  )  [  G^  ] " 1 

qq  cp  cp  cpcp         cp  (3-19 

as  the  desired  second-order  influence  coefficient 
(analytically  verified,  in  Appendix  C,  by  comparison  with 
directly  obtainable  results  for  a  simple  manipulator),  where 
the  superscript  (-T)  implies  the  transpose  of  the  matrix 
inverse.     At  this  point  one  should  recognize  that  equations 
(3-15)  and  (3-19)  allow  one  to  obtain  the  previously 
intractable  desired  influence  coefficients  in  terms  of 
simple  directly  addressable  coefficients  related  to  the 
initial  coordinates  (cp)  provided  the  first-order  (g,G) 
function  matrix  (i.e.,  Jacobian)  of  equations  (3-7)  is 
square  and  non-singular.     The  dependence  on  well-conditioned 
Jacobians  is  an  inherent  property  of  coordinate 
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transformation  and  will  not  be  dealt  with  to  any  significant 
extent  in  this  work.     The  use  of  pseudo-inverses  will, 
however,  be  discussed  with  regards  to  redundant  systems  in 
Chapter  IV. 

Kinemaic  transfer  of  dependent  parameters 

Suppose  the  transfer  of  the  dependence  of  a  general 
dependent  system  parameter  set  (u)  from  the  initial  (cp)  to 
the  desired  (g)  generalized  coordinates  is  reguired.  Here 
the  parametric  coefficients  of  eguations  (3-1)  are  desired, 
allowing  the  dependent  parameter  kinematics  to  be  expressed 
in  the  form  of  eguations  (3-2).     Recalling  the  first  of 
eguations  (3-4),  one  has  the  dependent  parameter  velocity 
( u)  as 


Now,  replacing  (<j>)  by  eguation  (3-14)  gives 

u  =  [Gu][G(?]-1g  (3 
cp  cp 

Comparing  the  result  of  eguation  (3-21)  with  the  general 
form  of  eguation  (3-2)  yields 


as  the  reguired  first-order  coefficient.  To  investigate  the 
second-order  kinematics,  recall  the  second  of  eguation  (3-4) 
for  the  dependent  parameter  acceleration 


u  =  (GuJcp 
cp 


(3-20) 


[Guj   =  [GU][G(3]-1 


(3-22) 


g        cp  cp 


u  =   [Gu]c£  +  cpT[Hu  ](£ 


(3-23) 
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Substituting  equation  (3-16)  for  the  initial  coordinate 
acceleration  (eg)  into  equation  (3-23)  gives 

U  =   [Gu][G<3j"12  -   [GU][G<3]"1£T[H<3  J&  +  6T[HU  ]cp 
cp      cp  cp      <p  epep  epep 

(3-24) 

Now,  applying  the  generalized  dot  (•)  operation  and 
combining  the  quadratic  terms  yields 

u  =   [Gu][G<3]"1g  +  £T{[HU  ]   -   ([GU][G(3]-1  •    [H<*   ]  )  }cp 
cp      cp  epep  cp      cp  epep 

(3-25) 

Where,  finally,  replacing  (g>)  with  equation  (3-14)  and 
comparing  the  result  with  the  second  of  equations  (3-2),  the 
desired  second-order  kinematic  influence  coefficient  is 

[HJV]   =   CG<5]"T{[HU   ]   -   ([GUJ[G<3]-1  .   [H<3  ])}[G<*]-1 

gq         cp         epep  cp     cp  epep  <p 

(3-26) 

Equations  (3-22)  and  (3-26)  again  give  expressions  for  the 
desired  coefficients  in  terms  of  the  easily  obtained  initial 
system  parameters,  and  reduce  to  the  direct  transfer 
coefficient  eguations  (3-15)  and  (3-19)  when  the  dependent 
parameter  (u)  considered  is  the  initial  coordinate  set  (cp) 
since 


(3-27) 

and 

[HU  =  [H<P  ]  =  [0]  =  MxMxM  „Q. 
'pep  (pep  (3-28) 
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Dynamic  Model  Parameters 

One  approach  (suggested)  to  the  transfer  of  the  dynamic 
model  is  to  employ  the  effective  load  relationship  of 
equation  (3-10)  along  with  the  previously  discussed 
kinematic  transfer  results.  From  equation  (3-10),  provided 
the  Jacobian  is  non-singular,  the  desired  generalized  loads 
(Tq)  can  be  expressed  as 

Tg  =  [G^J-Tt^  (3-29) 

or,  recalling  equation  (3-5), 

Tq  =  [G<JrT([I*  ]'£  +  £T[P*  -  TL) 

^  cp  cpcp  cpcpcp  ~cp  (3-30) 

Replacing  (cj>)  in  equation  (3-30)  by  the  result  of  equation 
(3-16)  gives 

Tq  =  [G<3]-T[I*   HCGS]-^.  -   [GSrVtH*  ]<p_) 
M  cp  cpcp        cp     —  q>  cpcp 

(3-31) 

+   [G<3rTcpT[p*     ]cp  -  [G<?rTTL 
cp  cpcpcp  —  cp  — cp 

which,  applying  the  generalized  inner  product  (•),  combining 
the  quadratic  terms  and  substituting  the  result  of  equation 
(3-14)  for  (cp)  ,  yields 

T     =   [G^]-T[I*  HGSriq 
ST  cp  cpcp  cp 

(3-32) 

+  qT[G<?]-T{([G<3]-T  .    [p*      ])    -   ([G<J]"T[i*  ][G<3]-1 
cp  cp  cpcpcp  cp  cpcp  cp 

•   £H<3   ])}[G«]-1q  -     E   (  [iGu]  [G<5]-1)T  i-Tu 
cpcp  cp  1=1        cp      cp  — 

Finally,  comparing  this  result  with  the  general  form  of 
equation  (3-3),  one  has  the  effective  generalized  loads  (Ta) 
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seen  by  the  desired  generalized  coordinates  (q)  in  terms  of 
parameters  directly  obtainable  from  the  initial  coordinates 
(cp_)  as 

T<5=   [I*   ]q  +  qT[p*     ]g  _  TL  (3-33) 
qq   -       -      qqq  -  ~q 


where 


[I*   J  =  [G<2]-T[I*  (3-34) 

qq         cp       cp<p  <p 

is  the  desired  generalized  inertia  matrix, 

[P*     ]  =  [G<3]-T{([G<3rT  .  [P*  ]) 

qqq        <p  <p  cpcpcp 

-  ([i*  J  •  [h^  j )  >[g<Jj-1 
qq         cpcp  cp 


(3-35) 


is  the  inertia  power  array  yielding  the  velocity  related 
effective  loads,  and  the  desired  effective  load  due  to  all 
applied  loads  (iTu,  i  =  l,2,...,n)  is 

TL  =  [G3]"T  Tl  (3-36) 
q  <P  ~~cp 

Alternately,  the  dynamic  model  can  be  transfered  by 
direct  use  of  the  generic  (for  constant  mass  systems) 
equations  (2-139),   (2-141)  and  (2-145)  once  the  desired 
(transferred)  kinematic  influence  coefficients  have  been 
obtained.     For  example,  consider  the  determination  of  the 
desired  effective  load  (t£)  due  to  applied  system  loads. 
Recalling  equation  (2-125),  one  has 


=  J1CiGUiT  ^u  (3-37) 
q       1=1       q  — 
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or,  recalling  equation  (3-22)  for  the  kinematic  transfer 

TL  =   .SMtiGUHGSj-ljT  1TU  (3-38) 
q      1=1        co      cp  -  v  ' 

Now,  to  demonstrate  the  equality  of  the  results  of  equations 
(3-36)  and  (3-38),  rewrite  equation  (3-38)  as 


TL  =  .8  fG<3]"T[iGUjT  iTu 
q      1=1     cp  cp        -  lJ  oy' 


which  becomes 


TL  =  [G^]-T  8  [iGu]T  LTn  (3-40) 
q  cp      i=l      cp  — 


Finally,  recalling  from  the  general  form  of  equation  (2-125 
that 


TL  =  S  [iG11]1  LTn  (3-41) 
"  cp      i=l      cp  - 


equation  (3-40)  can  be  written  as 

iL  - 


1L  =  [G<*rT  TL  (3_42) 
q  cp  — cp  y^ 


illustrating  the  equality  of  the  results  of  the  two  model 
transfer  techniques. 

As  previously  mentioned,  the  full  power  and  freedom  that 
this  transfer  of  generalized  coordinates  affords  one  when 
investigating  the  design,  analysis,  and  control  of 
complicated  mechanical  systems  will  become  apparent  through 
the  study  of  the  possible  applications  presented  in  Chapter 
IV.     Here  it  will  only  be  pointed  out  that,  with  the 
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particular  resultant  form  of  the  kinematic  and  dynamic 
models  presented  in  this  work,  the  generalized  scalar 
product  (•)  is  the  key  realization  and  operation. 

The  Linearized  Equations 

The  consideration  of  the  transfer  of  the  linearized 
dynamic  equations  and  the  resulting  state  space  model  will 
be  addressed  in  two  parts.     The  first  deals  simply  with  the 
direct  transfer  of  the  third-order  kinematics  (allowing  one 
to  determine,  for  example,  the  voltage  input  required  to 
obtain  a  specified  nominal  hand  trajectory),  while  the 
second  discusses  a  possible  state  model  resulting  from  a 
partial  transfer  of  coordinates. 

Kinematics 

Recalling  the  general  form  of  equation  (2-28)  and  the 
second  set  of  equations  (2-44),  the  third-order  time  state 
(q)  of  the  desired  coordinates     (q)  can  be  expressed,  in 
terms  of  the  initial  coordinates  (eg)   (e.g.,  the  relative 
joint  angles  of  a  serial  manipulator),  as 


or 
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where  the  influence  coefficients  are  considered  known  up  to 
the  third  order.     Now,  solving  equation  (3-44)   for  the 
initial  coordinate's  jerk  (i.e.,  cp)  ,  one  has 

J  =   [GSrVq  -     9j  cp  -     9J-C£)  (3-45) 
*  9  cp  9  cp 

or 

'£  =  [G5]_1(q  -  cpT([H<5  ]  +  2[H<3  ]T)cp  -   (c£T[D<3  J<p)cp) 
cp        —  epep  epep      ~~  cpcpcp  — 

(3-46) 

At  this  point  the  previously  derived  expressions  for  (eg) 
and  (cp_)   (i.e.,  the  results  of  equations  (3-14)  and  (3-18)) 
could  be  substituted  into  equation  (3-46),  the  result  could 
then  be  manipulated  and  compared  with  the  general  form  of 
equation  (2-44),  ultimately  yielding 

[D<P     ]   =  f([G3],[H<3  ],[D<2     ])  (3-47) 
qqq  cp         epep  cpcpcp 

However,  the  manipulation  required  to  obtain  a  nice  result 
(such  as  that  afforded  by  the  inner  product  for  the 
second-order  coefficient)  for  equation  (3-46)  is  excessive 
and  not  required  for  the  task  at  hand.     That  task,  again,  is 
the  evaluation  of  equation  (2-240)  relating  the  required 
actuator  voltages  to  the  nominal  joint  motions  (cp(t)) 
resulting  from  the  desired  end-effector  trajectory  (q(t)). 
Therefore,  to  obtain  the  required  voltages  (v) ,  all  one 
needs  to  do  is  solve  equations  (3-14),   (3-16)  or  (3-18),  and 
(3-45)  for  (eg),   (cp)  and  (cp)  in  terms  of  the  specified  hand 
motion  (q(t))  and  then  substitute  the  results  into  equation 
(2-240).     While  the  computational  effort  involved  here  (in 


what  might  be  referred  to  as  resolved- jerk  control)  is 
considerable,  the  procedure  is  straight-forward  with  the 
reguired  voltages  determined  off-line  and  only  their 
numerical  values  stored  for  real-time  recall. 


State  Space  Eguations 

The  presentation  here  (as  with  the  state  space  treatment 
of  Chapter  II),  while  conceptually  generic,  deals  specifically 
with  the  case  of  the  d-c  motor  actuated  serial  manipulator. 
In  this  case,  since  the  actuators  are  generally  associated 
with  the  joint  motions  and  cannot  be  practically  located  at 
the  end-effector,  only  a  partial  transfer  of  states  (i.e., 
generalized  coordinate  perturbation)  is  considered.  Here, 
the  dependence  on  the  linkage-related  states  (i.e.,  the 
joint  coordinate  perturbations  (6<p),   (6<j>),   (6cp))  is 
transfered  to  the  end-effector  motion  perturbations  (i.e., 
(6g),   (6g)  and  (6g))  while  the  actuator  locations  remain 
unaltered. 

Recalling  eguation  (2-241),  one  has 


/6&  \ 

"Fn! 

F12 

!F13~ 

F2l! 

F22 

'  r  23 

T-l 

f  31 1 

F32 

'  - 

i  r-33 

(&(£  \ 


+ 


Gil 
G21 
G31 


6V 


(3-48) 


where    the  partition  matrices  (Fj^  and  Gj_j  )  are  as  defined 
by  eguation  (2-242)  through  (2-252).     Now  referring  to  the 
form  of  the  kinematic  eguation  (2-5),   (2-11)  and  (2-28)  and 
applying  the  kinematic  transfer  concept,  one  can  express  the 
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joint  related  perturbations  in  terms  of  the  hand 
perturbations  as 


and 


6<p  =  [G^J-lSq 

<P 

6i  =  [Gc5j_16q 


[Gqj-l  /91VGqrl6q 

9      V$J  9 


(3-49) 
(3-50) 


6£  =   [G^J-^q  -  [GSrY^Wr^q 

<f>      -       <f>    Val/  9 

-    [G<3]-l[pJ\  -  ^VGqj-Y3^\[Gq]-l6q 
9      \\dvJ      \3$/    9      \9<L/]  * 


(3-51) 


Finally,  substituting  equations  (3-49),   (3-50)  and  (3-51) 
into  the  initial  state  space  representation  of  equation 
(3-48)  gives 

/6q 
6q 

14/ 


fii  ;_Fi2_; Fi3 

F21 i  F22  i F23 
F31 i     32  I F33 


Gil 

6q" 

+ 

^21 

6i 
\  / 

_G31_ 

6V 


(3-52) 


as  the  desired  state  model,  where 

,  1=1,2,3 
,  j=l,2,3 


A 

Gil  = 

Fil 

Fij  = 

A 

F21  = 

3  <P, 


F22 

A 

F23 


+•  [G<5](F2i  -  F22[G<3]-1f9^) 
^91^  +   LGC5]F22  ]  [G^J"1 


LG^]"1 


(3-53) 


[G<*]F 
CP 


2  3 
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F31  =  -F32[G<3]-Y32\[G(3]-1 
F32  =  F32[Gj]-l 

^33  =  F33 

with  the  partials  relating  the  desired  (q)  and  initial  (eg) 
coordinates  given  by  the  general  form  of  equations  (2-14), 
(2-35)  and  (2-43) . 

Equivalently ,  one  could  first  derive  expressions  for  the 
effective  joint  loads  (T^)  in  terms  of  the  desired 
coordinate  (q)  kinematics  (Thomas  and  Tesar,  1982b),  and 
then  follow  the  linearization  procedure  of  Chapter  II  to 
obtain  the  state  model  of  equation  (3-52).     This  method 
simply  reverses  the  order  in  which  the  transfer  of 
coordinates  takes  place  and  does  not  affect  the  results. 

Alternately,  one  could  work  with  the  original  (i.e., 
initial)  state  model  of  equation  (3-48)  and  simply  use 
equations  (3-49)  and  (3-50)  to  obtain  the  states  (i.e.,  6cp_ 
and  6cp)  in  terms  of  measured  end-effector  perturbations 
(i.e.,6q  and  6q)  .     This  is  the  more  common  approach 
(generally  taken  by  the  investigators  cited  at  the  beginning 
of  this  chapter)  but  does  not  yield  much  additional  insight 
with  regards  to  system  control.     Here,  the  state  model  (on 
which  the  controller  design  is  based)  is  still  referenced  to 
the  joint  coordinates  (eg),  whereas  the  transfer  procedure 
actually  affords  one  a  new  state  model  (directly  referenced 
to  the  desired  end-effector  motion  parameters  (q) )  on  which 
to  base  the  controller  design.     While  the  transferred  model 


approach  may  (or  may  not)  yield  a  better  controller  design 
(since,  after  all,  as  the  joint  perturbations  go  to  zero  so 
to  do  those  at  the  end-effector  (for  a  relatively-rigid-link 
device))  it  at  least  allows  one  to  view  the  system  from  a 
different  point  of  view. 


CHAPTER  IV 


APPLICATION  OF  GENERALIZED  COORDINATE  TRANSFORMATION  TO 
DYNAMIC  MODELING  AND  CONTROL- -A  UNIFIED  APPROACH 

The  transfer  of  generalized  coordinate  technique,  in 
conjunction  with  the  kinematic  influence  coefficient  based 
model  formulation  for  which  it  was  developed,  gives  one 
the  ability  to  consider  an  incredible  variety  of  linkages 
(and  their  interactions  with  one  another)  with  a  single 
unified  approach.     The  approach  involves  the  relatively 
simple  modeling  of  serial  kinematic  chains,  the  application 
(single  or  multiple)  of  the  transformation  equations,  and  if 
necessary  (e.g.,  when  dealing  with  redundancies)  the 
inclusion  of  classical  optimization  techniques,  such  as  the 
merhod  of  Lagrange  multipliers.     This  chapter,  then,  deals 
with  the  application  of  this  unified  approach  to  the 
analysis  of  a  representative  selection  of  single  and 
multiple  linkage  systems  illustrating  its  full  power  and 
scope.     In  addition,  the  utility  of  (and  reason  for)  the 
general  descriptive  notation  presented  in  the  Introduction 
is  more  fully  demonstrated  as  a  consequence  of  the 
applications . 
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Single  Closed-loop  Mechanisms 


Consider  an  unconstrained  general  M-degree  of  freedom 
serial  manipulator  (i.e.,  open  kinematic  chain)  operating 
relative  to  an  N-dimensional  space,  with  (M  >  N). 
Further, consider  that  the  free  end  (e)  of  this  chain  is 
connected  to  ground  by  a  constraint  of  degree  R  (relative  to 
the  same  N-space).     The  resulting  closed-loop  mechanism  is 
then  seen  (refer  to  Fig.  4-1)  to  be  of  mobility  (M-R).  Now, 
the  task  at  hand  is  to  analyze  this  mechanism  ( for  a  given 
configuration)  from  any  desired,   (M-R) -dimensional,  set  of 
generalized  coordinates. 

The  first  step,  as  is  always  the  case,  is  to  model  the 
system  as  if  it  were  an  unconstrained  open  kinematic  chain. 
Therefore,  using  the  modeling  procedure  developed  in  Chapter 
II  for  the  serial  manipulator  one  immediately  (directly) 


obtains 


[Ge] 


N  X  M 


(4-1) 


[He  ] 


N  x  M  x  M 


(4-2) 


[I*  J 
cpcp 


M  x  M 


(4-3) 


M  x  M  X  M 


(4-4) 


and 


M  x  1 


(4-5) 
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Figure  4-1.     Single  closed-loop  mechanism 
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where 


e  =  (e1,e2, . . . ,eN)T  (4_g) 


describes  the  motion  parameters  associated  with  the  free 
end,  and  the  initial  generalized  coordinates 

eg  =  (q>i  ,q>2  >  •  - -<Pm)  (4-7) 
are  associated  with  the  joint  freedoms  of  the  open  chain. 

Now,  with  M>N,   (M-N)  of  the  initial  coordinates  (cp_) 
must  be  involved  in  any  set  of  generalized  coordinates  since 
one  can  constrain  (or  control)  at  most  N  of  the  free  end 
freedoms  (i.e.,  R<N)  .     As  a  consequence  of  this 
redundant -like  situation  (i.e.,  M>N)  the  dependent  parameter 
set  (e)  must  be  augmented  by  (M-N)  of  the  initial 
coordinates.     Here,  for  convenience,  take  the  first  (M-N) 
components  of  (<p)  ,  defined  as  (a),  to  be  the  parameters 
chosen  to  augment  (e),  yielding 


a  \      /(M-N)  x  1N 

[--    =    --  --  -) 

e  /      V     N  x  1 


(4-8) 


as  an  intermediate  set  (w)  of  desired  coordinates. 

For  future  reference,  the  remaining  N  components  of  the 
initial  set  (eg)  are  defined  by  the  vector  (£)  ,  giving 


(M-N)  x  Is 

-  ] 

N  X  1 


(4-9) 


and  recalling  that  one  will  eventually  constrain  R  of  the 
parameters  (e),  define 
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=  N  X  1 


(4-10) 


where    the  set  (f)  describes  the  remaining  freedoms  of  (e) 
after  the  R  constraints,  which  allow  no  motion  of  the 
parameters  (c)(i.e.,  c=c=0),  are  applied.     Again,  as  with 
the  partitioning  of  (g>)  ,  the  sequential  ordering  in  the  set 
(e)  of  the  components  making  up  (f)  and  (c)  is  done  merely 
for  convenience  in  discussing  the  general  case  (i.e.,  it  is 
not  necessary) . 

Returning  to  the  augmented  set  (w) ,  one  is  now  able  to 
express  the  first-order  kinematic  influence  coefficients 
relating  the  intermediate  coordinates  (w)  to  the  initial 
coordinates  (cp)  as 


r  i ;  o  - 

(M- 

-N)  x 

(M-N) [ (M-N)   x  N 

CP 

GelGe 
cu  0 

N 

x  (M- 

-N)        1     N  x  N 

with  (from 

equation 

(4-1) ) 

[Ge 
a 

j  GeJ 
B 

=  [Ge] 
<P 

Recalling  that 


w  =  [Gw]cp 
(P 


=  M  x  M 
(4-11) 

(4-12) 


(4-13) 


one  sees  that  the  first  (M-N)  rows  of  equation  (4-11)  merely 
state  that 
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Correspondingly,  the  second-order  influence  coefficient 
matrix  becomes  (recalling  how  the  dimensions  of  the  super- 
and  subscripts  give  the  dimension  of  the  result) 


"  w  | 
Haa  i 

W  "i 

Mx(M-N)x(M-N) |mx(M-N)x(N) 

Hw  1 
(3a  1 

Hw 

MX(N)X(M-N)    |  Mx(N)x(N) 

[HW  ] 
<pcp 


where  the  first  (M-N)  planes  are  given  by 

[Ha  ]  =  [0J  =  (M-N)  x  M  x  M 
cpcp 

since 

a  =  a 


MxMxM 
(4-15) 


(4-16) 


(4-17) 


and    the  last  N  planes  ([H^,])  are  given  by  equation  (4-2). 

Next,  recalling  the  direct  transfer  equation  (3-15),  and 
noting  the  block  partitioned  form  of  equation  (4-11),  one 
has 


[G<P] 
w 


[Gw] 
CP 


-1  = 

[I] 

!  [0] 

_-[&erl 

[Ge] 

[a.]-i 

a 

(M-N)x(M 

-N) 

( M-N ) xN 

NX (M-N) 

NxN 

(4-18) 


for  the  intermediate  first-order  coefficients,  which 
recalling  equations  (4-8),   (4-9)  and  (4-10),  yields 


[G«>] 
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r ii  o- 

I 
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1  gP 
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f|  c 

=  MxM  (4-19) 
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Notice  that  the  parameters  (a)  are  still  independent  but  the 
parameters  (3_)  are  now  dependent  on  the  full  intermediate 
set  (w).     Now,  recalling  equation  (3-19),  the  intermediate 
second-order  coefficient  is 


[H<P  ]   =  -[GW]"T(  [Gwl_1  •   [Hw  ])[GW]_1  =  MxMxM 
ww  cp  cp  cpcp  cp 


(4-20) 


where  the  first  (M-N)  planes  are,  again,  MxM  null  matrices 
(since  (a)  is  independent)  and  the  last  N  planes  give 


[H&  ] 
ww 
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lHae 

Nx ( M-N ) x ( M-N )  |  Nx ( M-N ) xN 

NxNx ( M-N )  NxNxN 
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or,  recalling  equation  (4-10), 
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(4-22) 


Note  that,  due  to  the  form  of  ([G^]"1)  and  ([Hw]),  to  save 
unneccessary  multiplication  by  zero,  the  last  N  planes  of 
equation  (4-20)  can  be  (and  in  actuality  are)  obtained  from 


[hP  ]  = 

WW 


-[GwrT([Gf  j-i 

cp  P 


[He  ])[GW]"1 

cpcp        cp  (4-23) 


Now,  refering  to  equations  (3-33)  through  (3-36),  one 
can  obtain  the  intermediate  dynamic  equations  as 


Tw  =  [I*   ]w  +  wT[P*     ]w  -  TL 
WW  WWW  ~  — w 


(4-24) 
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or 


(wTa\ 
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where 


[I     ]  =  [GW]_T[I  ][GW] 
ww  cp  cpcp  cp 


(4-25) 


(4-26) 


[P' 


www 


=   [GW]"T{(  [GwrT  •   [P*     ])-([I*   ]   •   [Hw  ])}[GW]"1 
cp  cp  (pcpcp  ww  cpcp  cp 


and 


— w         cp  ~~ cp 


(4-27) 
(4-28) 


Again,  there  are  computational  simplifications  that  can  be 
made  in  equations  (4-26),   (4-27)  and  (4-28)  due,  not  only  to 
the  special  forms  of  the  component  matrices  in  the 
equations,  but  also  to  the  fact  that  (c=c=0)  here.  These 
simplifications  are  left  to  the  reader  to  investigate;  but 
it  needs  to  be  stressed  that  while  the  kinematics  of  the 
set  (a)  remain  independent  the  dynamic  effects  of  the 
system  on  (a)  have  been  altered  by  the  active  transfer  of 
the  N  parameters  (fj)  to  the  N  parameters  (e)  .     In  other 
words,  given  the  same  kinematic  state  (defined  by  say,  e(t)) 
and  applied  loading  condition,  the  intermediate  effective 
load  (wT^)  on  the  generalized  coordinates  (a)  is  not  the 
same  as  the  initial  effective  load  (^Tq).     Perhaps  the 
easiest  way  to  demonstrate  this  is  to  note  the  difference  in 
the  effect  of  the  applied  loads.     Recalling  equations  (4-18) 
and  (4-19),  equation  (4-28)  gives 


wia  ~ 


L  T   m  L 

cp5a  +  LwGaJT  cpTp 


(4-29) 
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where  the  preceding  subscripts  indicate  which  generalized 
coordinate  set  the  parameter  is  related  to  (i.e.,  the 
preceding  subscript  gives  additional  information  concerning 
the  independent  parameters). 

Now,  returning  to  equations  (4-25)  through  (4-28),  in 
light  of  the  R  constraints  (c)  it  is  convenient  to  define  a 
new  intermediate  parameters  set  (y)  given  by  the  remaining 
(M-R)  free  coordinates  as 


(M-N)xlN 
(N-R)xl, 


(M-R)xl  (4-30) 


With  this  notation  one  can  rewrite  equation  (4-25)  as 


*     |  * 
pwyy I Pwyc 


P*  'p* 
_  wcyl  wcy 

since  the  parameters  (c)  are  now  fixed  (i.e.,  c=c=0) .  Note 
that  equation  (4-31)  not  only  gives  the  effective  loads 
(Ty)  required  to  drive  the  (M-R) -degree  of  freedom  mechanism 
from  the  coordinate  set  (y)   (for  some  specified  kinematic 
state  y,  y,  y) ,  but  also  gives  the  resulting  constraint 
forces  (Tc)   (if  desired).     Additionally,  the  first  of 
equations  (4-31)  can  be  used  to  address  the  effects  of  (and 
on)  non-rigid  bearings.     The  similarity  between  the  closure 
approach  taken  here  and  the  7-R  mechanism  approach  to  the 
reverse  position  solution  of  the  general  6-R  manipulator  of 
Duffy  and  Crane  (1980)  and  the  Uicker  et  al.(1964)  iterative 
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analysis  method  should  also  be  noted.     Also,  the  results  of 
equation  (4-31)  are  verified  (in  Appendix  D)   (for  the  simple 
case  of  the  planar  5-Bar)  by  comparison  with  the  results  of 
a  direct  dyad-based  analysis. 

Now,  if  the  second  intermediate  coordinate  set  (y)  is 
the  desired  set  of  (M-R)  generalized  coordinates  from  which 
one  wishes  to  actuate  the  mechanism,  one  is  done.  If, 
however,  the  desired  set  of  coordinates  (q)  differs  from 
(y) ,  one  must  (in  part)  first  obtain  the  intermediate 
dynamics.     From  equation  (4-31),  one  has 

Ty  =  [I*   ]y  +  yT[P*     ]y  -  TL  (4_32) 

yy  ~     ~     yyy        ~y  y 

where  the  first  (M-R)  rows  of  ([I*  ])  gives  ([I*  ])  and  the 
first  (M-R)  planes  of  ([P*yy])  gives  ([P*yy]).     Next,  one 
needs  to  determine  the  influence  coefficients  ([#])  and 
([Hyy])  relating  the  desired  set  (q)   to  (y). 

Assuming,  for  now,  that  (q)  is  a  subset  of  the  parameter 
sets  (a),   (£)  and  (f)  one  merely  needs  to  recognize  that 

=        ^PJqPj        =       J,  (M_R) 

from  the  previous  results  of  equation  (4-19),  and  from 
equation  (4-22)  that 


[H0   J  = 

yy 


3  I  (3  ' 
Haa I Haf 

fal  ff 


=  Nx(M-R)x(M-R)  (4-34) 
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and  since  the  coordinates  (y)  are  now  considered  to  be  the 
generalized  coordinates  (i.e.,  independent)  that 

[GY]   =   [I]   =   (M-R)   x  (M-R)  (4-35) 

and 

[H^J   =   [0]   =   (M-R)   x  (M-R)   x  (M-R)  (4-36) 

Now,  following  the  technique  (which  will  be  more  rigorously 
illustrated  in  the  next  application)  implied  by  the 
construction  of  the  influence  coefficient  matrices  ([G™]) 
and  ([H^p])  relating  the  augmented  set  (w)  to  the  initial 
set  (eg),  one  can  simply  piece  together  the  required 
influence  coefficients 

[Gj]   =   (M-R)   x  (M-R)  (4-37) 

and 

IHS   ]   =   (M-R)   x  (M-R)   x  (M-R) 

YY  (4-38) 

from  the  known  relationships  of  equations  (4-33)  through 

(4-36)  for  any  (M-R)  desired  components  (q)  of  the  set  (a, 

§,  f ) .     Note  that  judicious  selection  of  (a)  will  simplify 

this  task. 

Finally,  the  desired  describing  equations  are  obtained 
from  a  second  application  of  the  generalized  transfer 
equations  as 

[GY]  =  [G^r1 

q  y 

(4-39) 

[HY  ]  =  -[g^-TugS]"1  •  [H<*  ]  )  [G^] _1 

qq         y        y  yy  y 
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and 


=   [I*   ]q  +  qT[P*     ]q  -  TL  (4-40) 

qq  -  qqq  ~~  ~q 


where 


[I*  ]  =  [G<2rT[I*  KG^]"1 
qq  Y  YY  Y 


[p*     ]  =   [G^j"T{(  [G«]-T  .   [p*     ])   -   ([i*   ]    •   [Hq  ])}[G<5J-1 
qqq            y              y  yyy  qq  yy  y 

TL  =  [G<2]-T  TL  (4-41) 

~q       y  ~y 


Thus,   (by  the  double  application  of  the  transfer  technique) 
one  is  able  to  model  any  sinqle-loop  mechanism  (with  the 
actuators  located  at  any  set  (q)  of  the  linkaqe  joints)  by 
simply  determininq  the  joint-referenced  model  of  an  open 
kinematic  chain.     Now,  if  the  actuators  are  associated  with 
coordinates  other  than  the  joints  (cp,  f)  themselves,  to 
obtain  the  required  coefficients  ([G^])  and  ([H^  ])  one 
must  take  care  to  use  the  qeneral  dependent  parameter 
kinematic  transfer  equations  to  carry  the  desired  parameter 
along  throughout  the  complete  transfer  process.     This,  then 
actually  allows  one  to  obtain  the  model  for  (any) 
generalized  coordinate  set.     In  fact,  this  procedure  avails 
itself  to  the  analysis  of  the  two  main  types  of  special-case 
single-loop  linkages.     Those  being;  mechanisms  containing 
unspecified  independent  coordinates,  and  mechanisms  having 
one  or  more  redundant  constraints.     These  two  cases  are 
discussed  briefly  in  Appendix  D  in  terms  of  the  spatial 
slider-crank  and  Bricard  mechanisms,  respectively. 
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Multi-loop  Parallel  Mechanisms 


The  procedure  for  the  modeling  of  multi-loop  parallel 
mechanisms  is  not  as  one-directional  as  that  for  the 
single-loop  case,  and  therefore,  is  not  addressed  in 
all-inclusive  general  terms.     This  is  not  to  say  that  a  much 
more  general  class  of  parallelism  cannot  be  addressed  by  the 
same  procedure,  but  simply  that  there  is  no  single  general 
outline  for  the  infinite  variety  of  conceivable  parallel 
devices.     Here,  the  primary  concern  will  be  for  linkages  of 
the  class  illustrated  by  the  generalized  Stewart  platform 
represented  in  Fig.  4-2,  where  the  figure  is  intended  to  be 
viewed,  for  example,  as  six  general  six-degree  of  freedom 
manipulators  all  grasping  the  same  object  (or  having  a 
common  end-effector.     Also,  by  class  what  is  meant  is  that 
each  branch  (or  leg)  has  the  same  number  of  joints  as  the 
mechanism  has  freedoms  (i.e.,  in  the  single-loop  case  M  =  N) , 
and  that  there  are  no  coupling  links  between  legs  (which 
would  reguire  non-general  technigues  to  obtain  the  related 
influence  coefficients). 

Now,  addressing  the  six-degree  of  freedom  mechanism  of 
Fig.  4-2  (i.e.,  the  generalized  Stewart  platform),  suppose 
that  one  wishes  to  model  (or  control)  this  device  from  any 
collection  of  six  of  the  thirty-six  of  joint  freedoms  (i.e., 
generalized  coordinates  where,  as  in  the  single-loop 
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Desired  Generalized  Coordinates 

q  =   <iV  2^3*1 '4*1 '5*1' 6*1 )T 
Initial  Generalized  Coordinates 

r2=   (rVrVrVrVrVrVT  ;   r  =  1'2" 


Figure  4-2.     Generalized  Stewart  platform 


situation,  one  notes  that  the  joint  motion  parameters  are 
not  the  only  possible  generalized  coordinates).     Again,  the 
first  step  is  to  directly  model  the  system  with  respect  to 
some  initial  set  of  coordinates.     Here  the  approach  is  to 
model  each  leg  ( r=l , 2 , . . . , 6 )  with  respect  to  its  own  joint 
coordinate  set  (rcp_)  as  if  the  other  legs  did  not  exist. 
This  yields,  using  the  serial  manipulator  procedure  of 
Chapter  II,  six  sets  of  describing  equations,  with  the  rth 
one  given  by 

(rS  )  =  [rGw],[rHw  ],[rI*  ],[rP*     ],rTL  f4_42, 

^  ^(P  (PCP  <PCp  cp<P(p  r— CP  1 4-4^  J 

where  (w)  is  an  intermediate  coordinate  set  associated  with 
the  six  parameters  describing  the  motion  of  the  platform, 
and  where  the  mass  of  the  platform,  along  with  any  load 
applied  directly  to  the  platform,  is  neglected  (although  it 
could  be  included  in  the  model  of  one  of  the  legs). 

Next,  apply  the  transfer  equations  to  each  leg  yielding 

[rG<P]  =   [j-G"]-1  (4-43) 
w  cp 

trH<P   ]  =  -[rGw]-T([   gw]-1  •   [rHw  nUG*]"1  (4_44) 

ww               cp          1  (p  x  epep      r  cp 

[rI* ]   =   irG«]-T[rl*   J[rGwj"l  (4-45) 
ww  cp  epep  (p 


[rp*     j  =  [rGw]-T{([  GWJ"T  .   [   p*  ], 
www  cp  cp  r  epepep 


~([rI     ]   •   [rHw  l)}:^]-1 
ww  epep  cp 


(4-46) 


and 


rTL  =  [rGw]"T  rTL  (4-47) 


~V       "r  cp  r-cp 
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for  the  model  of  each  leg  referenced  to  the  intermediate 
coordinates  (w) .  Now,  combining  the  effects  of  each  leg  and 
including  the  inertial  effects  of  the  platform  and  the 
resolved  vector  of  loads  applied  directly  to  the  platform, 
one  has 


and 


where 


[I     J  = 

WW 


[P  ] 
www 


CW  +  r5ilri*  ] 

r— 1  ww 

=  rpwwwi  +  i  crp*  j 

r=l  www 


rmL 


~w 


r=l 


L  ^ww^ 


M 


67 


M 


67 


M 


67 


[II67] 


(4-48) 


(4-49) 


(4-50) 


and  where  the  first  three  planes  of  ([P^])  are  6x6  null 
matrices,  and 


^  PWWW  ^ 1 ; ; 


0 

1 

.  o 

0 

1  =  4,5,6 


(4-51) 


where 


[P4ww]  =  [0;iz.'-lY]  =  3x3 

tp5ww^  =  r-iz;o;ix]  =  3x3 

£p6wwl  =  [IY:-Ix;0]  =  3x3 


(4-52) 
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with 


since  (by  choice) 


[II67]  =  [ix;iy;iz] 


(4-53) 


6vc 


w  = 


to 


67 


(4-54) 


At  this  stage,  having  obtained  the  description  of  the 
total  mechanism  referenced  to  the  intermediate  parameters 
(w) ,  one  may  proceed  to  transfer  the  model  to  any  desired 
set  (q)  of  six  of  the  thirty-six  joint  freedoms.  Here,  for 
illustration,  assume  that  the  desired  coordinates  are  the 
base  joints  of  each  leg,  or 

q  =  (i<t>i,   2*1  6*1  >T  (4-55) 

yielding,  for  the  first-  and  second-order  influence 
coefficients  relating  the  desired  coordinates  (gj  to  the 
intermediate  coordinates  (w)   (from  equations  (4-43)  and 
(4-44) ) 


and 


w 


w  x' 


w  ±r 


[bG<P]T. 
L  w 


[H<3  ]  = 

WW 


i1^  ll.. 

WW    x'  ' 

[2H*  ],.. 

_   WW  _" 

[%*"  ]i~  . 

WW    ±r  ' 


(4-56) 


(4-57) 
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Before  continuing,  note  that  (in  general)  if 

3n  =  r^m  (4-58) 

then 

E*j]n,  ■  Cr<*l.,  ,4-591 

and 

(H<2  ]n..  =  [rH^  ]m..  fin. 

WW      '  '                WW      '  '  (  4-6U ) 

Finally,  applying  the  transfer  eguations,  one  obtains  for 
the  desired  describing  eguations 

Tg  =   [I*   ]q  +  gT[P*     ]q  -  TL 

gg  -       -      ggg  -      -q  (4-61) 


where 


CI*   ]   =   [G<3rT[I*  KG0!]-1 
gg  w         ww  w 


t p  *  _ J  =  [Q«]-T{([G9J-T  •  [P*     ])  -  ([I*  ]  •  [H<3  ])}[G^]-1 
ggg  w  w  www  gg  ww  w 


(4-62) 


TL  =   [ G^ ] TL 
g         w  ^w 


with 


[Gw]   =  [G<3j"l 

g  w  (4-63) 


and 


[Hw  ]  =  -[G<J]-T(  [G^T1  •   [H<2  JUGS]"1 
gg  ww  ww  w 


(4-64) 


Here,  the  dynamic  model  of  an  extremely  complicated 
multi-input  spatial  mechanism  has  been  derived  in  terms  of 
relatively  simple  serial  manipulator  relationships,  again, 
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Desired  Generalized  Coordinates 

H  =   (l(pi'2Cpl'3(pl'94'CP5'(P6)  T 
Initial  Generalized  Coordinates 

r£  =   'rVrVrVVVV*  ;   r  =  X'2'3 


Figure  4-3.     Parallel-serial  mechanism 
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via  a  double  application  of  the  generalized  coordinate 
transfer  equations.  In  fact,  the  hybrid  parallel-serial 
mechanism  (Fig.  4-3)  treated  by  Sklar  (1984)  can  be  modeled 
using  the  same  procedure.     To  see  this,  simply  include  ((P4), 
((P5)  and  (cpg)  in  each  of  the  three  initial  sets  (rcp, 
r=l,2,3).     Include  the  inertial  effects  of  links  (3),  (4), 
(5)  and  (6)  in  the  direct  (initial)  modeling  of  one  (and 
only  one)  branch,  and  note  that  (cp4),   ((p5)  and  (<p6)  must 
(also)  be  included  in  the  desired  coordinate  set  (q).  Also 
note,  the  reverse  position  problem  (i.e.,  specify  (w)  and 
determine  (q) )  for  both  devices  can  be  addressed  using  the 
analysis  techniques  of  Duffy  (1980)  and  Duffy  and  Crane 
(1980).     The  results  of  this  parallel-mechanism  analysis  are 
verified  (in  Appendix  E)  by  simulation  of  a  simple 
three-degree  of  freedom  planar  device. 

Redundant  Systems 

Consider  a  general  M-degree  of  freedom  system  (ge  RM) 
operating  relative  to  an  N-dimensional  space  (  RN). 
Further,  consider  that  there  exists  a  superabundance  of 
kinematically  independent  inputs  (g)  with  which  to  obtain 
the  most  general  motion  possible  (ue  RN )  for  a  free 
unconstrained  body  (u)  residing  in  that  space  (i.e.,  M>N). 
This  superabundance  of  kinematically  independent  inputs 
(refered  to  here  and  in  the  general  literature  as 
redundancy)  is  perhaps  most  easily  illustrated  by  the 
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general  serial  manipulator  with  more  than  six  inputs  (i.e., 
M>N=6).     The  situation  is  of  course  exhibited  by  a  much 
broader  class  of  systems.     Take  for  example,  the  planar, 
multi-loop,  parallel  six-degree  of  freedom  mechanism  shown 
in  Fig.  4-4.     Here,  there  are  six  independent  inputs  (all  of 
which  must  be  controlled)  available  to  drive  the  system 
according  to  the  most  general  motion  specification  possible 
(i.e.,  x=x(t),  y=y(t)  and  @=9(t)).     Therefore,  there  are 
three  redundant  inputs  (three  more  than  required)  in  this 
particular  robotic  device.     Alternately,  this  type  of 
redundancy  exists  when  only  a  partial  specification  (e.g., 
translation  but  not  orientation)  of  the  end-effector 
trajectory  of  a  general  six-degree  of  freedom  serial 
manipulator  is  made,  or  when  the  trajectory  is  obtainable 
with  a  subset  of  the  available  inputs.     Now,  without 
considering  the  specifics  of  the  particular  system  in 
question,  or  the  justification  of  the  optimization  criteria 
(i.e.,  cost  function)  employed,  the  application  of  the 
transfer  of  generalized  coordinates  to  the  modeling  of 
redundant  mechanisms  will  be  discussed. 

Here,  it  is  assumed  that  the  position  of  the  system  is 
known  and  that  the  dynamic  model  of  the  system  with 
respect  to  the  desired  coordinates  (q)  has  been 
established,  yielding 

q  —  (4-65) 
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Figure  4-4.     Six-degree  of  freedom  planar  device 
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(4-66) 


and 


(4-67) 


In  viewing  equations  (4-65),   (4-66)  and  (4-67),  one  sees 
that  the  relationships  are  unique  for  specified  values  of 
the  desired  coordinates  (q)  velocities  (q_)  and  accelerations 
(q) .     Unfortunately  (from  the  modeling  and  control  point  of 
view)  however,  the  desired  coordinate  kinematics  (i.e.,  q 
and  q)  are  not  uniquely  determined  by  specification  of  the 
desired  kinematics  (i.e.,  u  and  u)  of  the  controlled 
variable  (u) . 

Therefore,  the  first  step  is  to  determine  (M-N) 
additional  constraining  relationships  between  the 
coordinates  (q)  and  (u) .     Here,  one  typically  decides  to 
optimize  (instead  of  arbitrarily  specifying  (M-N)  kinematic 
relationships  among  the  (q))  some  performance  criteria 
involving  the  superabundant  coordinates  (q)  subject  to  the 
required  kinematic  constraints  (e.g.,  equation  (4-65)) 
relating  the  controlled  parameter  (u)  to  (q) .     Once  the 
performance  criteria  is  established  one  can  use  any  of  a 
number  of  optimization  techniques  (e.g.,  the  classical 
Lagrange-multiplier  approach)  to  determine  the  additional 
constraints  between  (q)  and  (u) .     The  end  result  of  this 
being  the  reverse  of  equation  (4-65),  or 


q  =  [G<5]u 


(4-68) 


u 
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where 


[G<3]   =   [GUJ"R  =  MxN  (4-69) 
u  q 


is  the  pseudo  (right)  inverse  of  the  unique  (NxM)  jacobian 
of  equation  (4-65).     For  example,  if  one  wishes  to  minimize 
the  kinetic  energy  of  the  system  (i.e.,  equation  (2-140)), 
subject  to  the  constraint  of  equation  (4-65),  one  obtains 
(Whitney,  1969) 

[GUTR  =  [I*  ]"1[GU]T([GU][I*  ]-1[Gu]T)-1 

q  qq       q       q     qq  q 

(4-70) 

for  the  desired  pseudo  inverse. 

Having  established  the  pseudo  inverse  given  by  equation 
(4-69),  one  can  (though  it  is  not  necessary)  now  apply  the 
coordinate  transfer  technique  to  obtain  the  reverse  of 
equation  (4-66)  as 

g  =  [G<3]U  +  uT[H<5  ]U  (4-71) 

u  ~        ~        UU  " 


where 


[Hq  ]  =  -[gu]-rt([guj-r  .  [hu  ])[GurR     / a  79> 

uu  q  q  qq  q 


Now,  finally,  substituting  the  results  of  equations  (4-68) 
and  (4-70)  into  equation  (4-67)  yields 

Tq  =  [I*   ]u  +  uT[P*     ]u  -  [G^]-RTTu 
H  qu  quu  _  q  (4-/3) 


as  the  effective  generalized  loads  at  the  desired 


coordinates  required  to  obtain  the  specified  controlled 
variable  kinematics  in  accordance  with  the  given  performance 
criteria,  where 

[I*  ]  =  [I*  ][GurR  =  [GU]T([GU][I*  r1^]7)"1  =  MxN 
qu  qq       q  q  q       qq  q 

(4-74) 

and 

[P*     ]  =  (GurRT{[P*     ]  -  ([I*  ]   •   [Hu  ])}[GurR  =  MxNxN 
quu  q  qqq  qu  qq  q 

(4-75) 

Here  (see  also  Thomas  and  Tesar,  1982a,  equation  (3.35)  for 
a  non-redundant  manipulator),  it  should  be  noted  that  the 
effective  loads  at  (q)  are  expressed  directly  in  terms  of 
the  controlled  variable  kinematics  resulting  in  what  could 
be  refered  to  as  a  partial  transfer  of  coordinates. 

Overconstrained  Systems 

The  devices  considered  in  this  section  can  also  be 
thought  of  as  redundant,    in    that    the  redundancy  comes  from 
a  superabundance  of  kinematically  (dependent)  inputs,  as 
illustrated  by  the  three-degree  of  freedom,  four  (and 
six) -input  systems  of  Fig.  4-5.     This  situation  is 
dramatically  different  from  the  previous  case  where  the 
superabundance  was  of  kinematically  (independent)  inputs. 
In  that  case,  the  only  kinematic  invariant  is  the  controlled 
variable  itself,  and  the  joint  loads  are  uniquely  determined 
after  the  remaining  system  kinematics  are  selected  (via 
optimization).     Here,  once  the  kinematics  of  the  controlled 


140 


Figure  4-5.     Overconstrained  systems,   a)   Walking  Machine  ; 

b)   Multi-fingered  hand/Cooperating  Manipulators 
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variable  are  specified,  the  kinematic  state  of  the  entire 
system  is  uniquely  determined  (i.e.,  all  system  parameters 
are  kinematically  invariant  with  respect  to  the  controlled 
variable).     The  result  of  this  invariance  is  an  antagonistic 
(rather  than  cooperative)  situation,  where  the  load 
generated  by  one  input  is  geometrically  (rather  than 
through,  dynamic,  inertial  effects)  transferred  to  the 
others.     As  illustrated  by  the  planar  examples  of  Fig.  4-5, 
this  is  exactly  the  situation  encountered  when  dealing  with 
the  coordinated  action  of  multiple  open-chain  systems,  such 
as  walking  machines,  multi-fingered  hands  and  cooperating 
manipulators . 

Here,  without  loss  of  generality,  the  specific  case  of 
the  two-fingered  hand  (Fig.  4-5b)  is  addressed.     In  addition 
to  the  analytic  generality  afforded  by  this  example,  it  also 
allows  the  reader  to  immediately  verify  (by  simple 
experiment)  the  absolute  necessity  of  the  direct  actuation 
of  the  four  parameters 

q  =   (icP!,   X(P2,   2*1'   2<P2>T  (4-76) 
to  even  hold  the  object  (u)  stationary  (much  less  maintain 
some  kinematic  trajectory).     Therefore,  one  must  determine  a 
balanced  loading  among  the  four  actuators  while, at  the  same 
time  maintaining  the  desired  kinematics  of  the  dependent 
controlled  variable  (u) . 

The  first  step,  once  the  kinematics  of  (u)  are 
specified,  is  to  obtain  the  model  of  the  system  (where  the 
contact  points  are  viewed,  instantaneously,  as  pin  joints) 


referenced  to  the  intermediate  generalized  coordinates  (u) . 
To  do  this  one  follows  exactly  the  same  procedure  as 
represented  in  the  parallel  mechanism  section  (equations 
(4-42)  through  (4-60)  with  w=u) ,  yielding  the  unique  results 


and 


TU  = 


[G<3J 
u 


[I*  ]u  +  uT[P*     ]u  -  TL  =  3x1 
uu 


uuu 


~u 


(4-77) 


U    '  x 

[^1.2 
u  '  ^ 


[2G^].! 
u  '  1 


[20*] 


u 


;2 


=  4x3 


CHS   ]  = 
uu 


(4-78) 


=  4x3x3 


(4-79) 


Now,  to  distribute  (via  the  Lagrange-multiplier 
approach)  the  required  generalized  load  (Tu)  between  the 
actuators  (q)  while  maintaining  the  desired  kinematics  one 
may  use  any  of  a  number  of  objective  functions  (i.e., 
optimizing  criteria),  but  must  use  the  constraint 
relationship 


C  =   [G^jTTq  -  Tu  =  0 


(4-80) 


143 


since,  because  the  kinematics  are  unique,   (Tu)  is  unique. 
If,  for  example,  one  decides  to  minimize  the  sum  of  the 
squares  of  the  desired  torques  (i.e.,  the  square  of  the  p=2 
norm) ,  then  the  objective  function  is  qiven  by 

£  -  ^  3,  (4-81) 


yielding,  with  the  constraint  (c) ,  the  Lagrangian 

nT 


f  =  T„T  Tg  +  ^([G^TTg  -  Tu)  (4_82) 


Setting  the  partials  with  respect  to  the  independent 
variables  to  zero  gives 


3f\T  =  2Ta  +  [G^JX  =  0  =  4x1  (4-83) 


and 


resulting  in 


3Tq 


3f  \  =  [GS]TTq  -  Tu  =  0  =  3x1  (4-84) 


^  =  [Gq)((Gq]T[Gg]rlSu 


which,  when  compared  with  equation  (4-80),  gives  the  pseudo 
(left)  inverse  transpose 

[G<3]-LT  =   [GU]T  =   [G<3]([G<3]T[G<*])-1  =  4x3  Q,, 
u  q  u         u         u  (4-86) 

Finally,  applying  the  transfer  equations  once  more 
(i.e.,  substituting  equation  (4-77)  into  equation  (4-85)), 
one  obtains  the  desired  distributed  load  (Tg)  as 
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TCT  =   [I*   ]u  +  u' 


T[p*     ]u  _  TL 


qu  ~ 


quu  ""      — q 


(4-87) 


with 


[I*  ]  =  [GS]"LT[I*  ]  =  4x3 


qu  u  uu 


(4-88) 


[P*     ]  =  ([G<3]"LT  •   [P*     ])  =  4x3x3 


quu  u  uuu 


(4-89) 


and 


~q  u  ~u 


(4-90) 


where,  again,  only  a  partial  transformation  of  coordinates 
is  employed.     As  with  the  solution  for  the  redundant  case 
(equation  (4-73)),  the  partial  transfer  is  employed  because 
the  resulting  equations  are  in  the  desired  form;  that  is, 
the  (desired)  required  generalized  loads  are  expressed 
directly  in  terms  of  the  controlled  variable  kinematics. 


CHAPTER  V 


CONCLUSIONS 

The  major  thrust  of  this  work  has  been  the  development 
of  a  single  general  method  which  allows  one  to  investigate 
the  dynamics  of  (almost)  any  rigid-link  mechanism  (or  system 
of  mechanisms)  from  any  desired  set  of  generalized 
coordinates.     The  method  reguires  the  determination  of  an 
initial  dynamic  model(s)  in  terms  of  the  simplest  linkage 
possible,  the  open- loop  kinematic  chain.     Once  this 
elementary  model(s)  is  obtained  the  principle  of  virtual 
work  and  the  kinematic  constraints  (i.e.,  kinematic 
influence  coefficients)  relating  the  initial  generalized 
coordinates  to  any  other  set  of  generalized  coordinates 
allow  the  determination  of  the  model(s)  referenced  to  the 
other  (desired)  set  of  coordinates.     Thus,  one  is  able  to 
determine  the  dynamic  model  of  extremely  complicated  linkage 
systems  (or  systems  referenced  to  an  obscure  set  of 
generalized  coordinates)  in  terms  of  easily  obtained 
elementary  open-chain  model  parameters.     The  approach  was 
shown  to  enable  the  dynamic  analysis  of 

1.     The  general  serial  manipulator  in  terms  of  the  end- 
effector  coordinates  (or  any  other  set  of 
generalized  coordinates). 
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2.  Single-loop  mechanisms  referenced  to  any  generalized 
coordinate  set. 

3.  Multi-loop  parallel-input  mechanisms. 

4.  Systems  with  a  superabundance  of  kinematically 
independent  inputs. 

5.  Systems  with  a  superabundance  of  kinematically 
dependent  inputs. 

Because  of  the  dependence  of  the  unified  approach  on  the 
chosen  generic  model  form  and  the  relative  joint  angle 
referenced  open-loop  kinematic  chain,  an  exhaustive 
treatment  of  these  elementary,  yet  fundamental,  concepts  was 
given.     In  addition,  a  new  and  descriptive  notation  was 
developed  as  an  illustrative  aid  in  the  analysis  of  the 
systems  discussed.     The  graphic  separation  of  dependent  and 
independent  system  parameters  afforded  by  this  notation  is 
extremely  beneficial  when  dealing  with  the  transference  of 
system  dependence  among  various  sets  of  generalized 
coordinates,  and  is  the  primary  reason  for  its  introduction. 

The  main  drawback  of  the  overall  approach  is  the  need  to 
invert  the  Jacobian  relating  the  desired  generalized 
coordinates  to  the  initial  generalized  coordinates.     This  is 
not  only  computationally  demanding,  but  is,  of  course,  also 
subject  to  singularities.     While  the  issue  of  singularities 
was  not  addressed  in  the  work,  it  is  noted  that  a  singular 
Jacobian  does  not  mean  that  the  system  cannot,  in  general, 
attain  the  desired  motion.     What  is  meant  is  that  a 
reduction  in  the  allowable  motion  space  has  occurred,  and  if 
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the  desired  motion  is  not  in  that  reduced  space,  it  cannot 
be  obtained.     Again,  while  the  issue  of  singularities  is  not 
dealt  with  in  general,  the  treatment  of  the  Bricard 
mechanism  (Appendix  D)  addresses  a  special  case  of  this 
phenomena . 

As  comprehensive  as  this  work  is,  it  is  merely  a 
foundation  on  which  to  base  the  more  complete  treatment 
reguired  for  real-time  dynamic  compensation  and  control  of 
robotic  devices.  To  achieve  the  ultimate  goal  of  precision 
operation  under  load  will  reguire  considerably  more  than  the 
rigid-link  model  presented  here.     Of  high  priority  for  the 
immediate  future  (and  addressable  by  the  concepts  developed 
in  this  work)  are  the  issues  of 

1.  Metrology  (Behi,  1985) 

The  determination  of  the  system  parameters  reguired 
for  the  guantitative  model  (e.g.,  link  dimensions, 
mass  and  stiffness  parameters,  etc.). 

2.  Local  Compensation  for  In-Plane  Deformation 
(Tesar  and  Kamen,  1983) 

Both  feedforward  and  feedback  compensation  for  link 
and  actuator  deformations  occurring  in  the  plane 
locally  addressable  by  each  individual  actuator. 

3.  Global  Compensation  for  General  Deformations 
(Fresonke,  1985) 

Feedforward  and  feedback  compensation  for  dynamic 
and  load  induced  end-effector  deflection  due  to 
general  link  deformations. 
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4.  Sufficient-Model  Determination  (Wander,  1985) 
Investigation  of  the  controlling  eguations  to 
determine  the  minimum  model  (as  well  as  the  most 
efficient  computational  scheme)  sufficient  for 
real-time  dynamic  compensation. 

5.  Control  of  Redundant  Systems  (Tesar  and  Kamen,  1983) 
Determination  of  algorithms  appropriate  for  the 
control  of  systems  with  a  superabundance  of 
kinematically  independent  inputs  envisioned  for  the 
separation  of  large  and  small  motion  priorities,  as 
well  as,  for  enhanced  operating  volume  and 
dexterity. 

6.  Control  of  Overconstrained  Systems  (Orin  and  McGhee, 
1981) 

In-depth  investigation  of  the  antagonistic  nature  of 
systems  with  a  superabundance  of  kinematically 
dependent  inputs  (e.g.,  walking  machines, 
multi-fingered  end-effectors,  cooperating  robots) 
aimed  at  the  determination  of  the  ideal  set  of 
generalized  coordinates  for  control. 

7.  Hybrid  Control  (Raibert  and  Craig,  1981) 
Investigation  of  system  control  in  terms  of  a  set  of 
generalized  coordinates  consisting  of  a  mix  of 
kinematic  and  dynamic  parameters. 

In  conclusion,  while  there  is  much  to  be  done,  it  is 
suggested  that  this  work  removes  (to  a  large  extent)  one  of 
the  most  difficult  tasks  facing  the  design  (or  control) 


engineer.  That  is,  the  determination  of  the  basic 
mathematical  model  representing  the  system  dynamics.  It 
hoped  that  the  removal  of  this  burden  (and  the  additional 
insight  obtained  by  viewing  the  system  from  different  set 
of  generalized  coordinates)  will  encourage  one  to  be  more 
creative  and  investigate  the  possibility  of  systems  that 
might  otherwise  be  thought  unattainable. 


APPENDIX  A 


DEVELOPMENT  AND  DEFINITION  OF  GENERALIZED 
SCALAR   ( • )    PRODUCT  OPERATOR  FUNDAMENTAL  TO 
DYNAMIC  MODELING  AND  TRANSFER  OF  COORDINATES 


Quadratic  Operation  of  a  Matrix  on  a  3-dimension  Array 
Given 

[D]  =  M  x  N  Matrix 
[C]  =  N  x  M  x  M  Array- 


Define 


[D]T[C][D]  = 


*[D]T  [C]1..[D] 
[DTJ  [C]2..[D] 


[D]T  [C]N;;[D] 
=  N  x  M  x  M  Array 

Where 

[ C J n . ;  =  nth  plane  of  [C] 
=  M  x  M  Matrix 


2.     Quadratic  Operation  of  a  Vector  on  a  3-dimension  Array 
Given 

b  =  M  component  column  vector 


Define 


bT[C]b  =  /bT[C]1;.  b\ 
bT[C]  -).  .  b 


bT[C]n. .  b 
—        11 z  ,  — 


/ 


=  M  x  1  Vector 
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3.     Vector  Multiplication  of  Quadratic  Result 


Given 


[A]  =  P  x  N  matrix 
[A]p.  =  Pth  row  of  [A]  =  <[A]pjlf  [A]p;2 

[A]p;N) 


,    .  .  .  , 


Then 


[Ajp; (bT[C]b)  =  [Ajp;1bT[C]1;;b  +  CA]p;2bT[C]2; .b 
+   .    .    .   +  [A]p;NbT[C]N;;b 
.  =  bT[A]p;1[C]1;;b  +  bT[A]p;2[C]2;;6 
+   .    .    .   +  bT[A]p;N[C]N;;b 

=  *>T(  Jx  [A]p;n[C]n;;jb 
=  scalar 


Define  Operator  (•)  "Dot" 


N 


([A]p.  •  [ C ] )  =  (     E     [A^p;nLc]n; ; J  =  N  x  N  matrix 

=  scalar  multiplication  of  planes  followed 
by  a  summation  of  the  resulting  planes 


Matrix  Multiplication  of  Quadratic  Result  using  ( • ) 
operator 


[A](bT[c]b)  =  /bT([A]1;     •  [c])b 
bT([A]2.     •  [C])b 


bT([A]p.      •  [C])b/ 


\- 


=  bT( [A]  •  [C] )b 
=  P  x  1  vector 
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Where 

([A]   •  [C])  =  P  x  M  x  M  array 

Therefore 

(fiQUjT^MUjj^TflHU  ^  =  (  ( [  iQu  j  T  [  ifju  ] )   .   [iHu  ])q 

q                 qq  -  q                  qq  ~ 


APPENDIX  B 

SECOND-ORDER  TRANSFER  FOR  A  SIMPLE  MANIPULATOR 

Here  the  specific  case  of  the  wrist-partitioned 
manipulator  shown  in  Fig.  B-l  and  treated  by  Hollerbach  and 
Sahar  (1983)  is  addressed.     In  this  class  of  manipulator 
(i.e.,  wrist-partitionable )  the  orientation  of  the 
end-effector  is  completely  specified  by  (and  completely 
specifies)  the  last  three  joint  positions.     This  allows  the 
inverse  kinematics  of  the  first  three  joints  (cj>)  to  be 
obtained  in  terms  of  the  cartesian  coordinates  of  a 
wrist-point  (P) ,  where  the  wrist-point  (P)  is  determined 
directly  from  the  position  and  orientation  of  the 
end-effector.     (i.e.,  independent  of  the  last  three  joints). 
As  a  result  of  this  partitioned  solution  capability  the 
kinematic  influence  coefficients  relating  the  joint 
coordinates  (<g)  to  the  wrist  coordinates  (P)  can  be 
determined  directly  (and  simply),  without  the  need  to  employ 
the  transfer  of  generalized  coordinate  approach.  Therefore, 
the  wrist-partitioned  manipulator  is  ideally  suited  to  serve 
as  vehicle  to  verify  (algebraically)  the  results  of  the 
generalized  coordinate  transformation  approach  to  the 
inverse  kinematics  problem  (specifically,  the  transferred 
(h,H)  function  result). 
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Assuming  that  the  kinematics  of  the  wrist-point  (P)  are 
known,  one  can  express  the  acceleration  vector  (c£)  in  the 
general  form  of  eguation  (2-27)  as 

'6  =  [G<P]P  +  PT[H*  ]P 
P  ~      ~      PP  ~ 

Here,  for  brevity,  only  the  acceleration  of  the  first  joint 
will  be  considered.     From  eguation  (B-l),  one  has 


e-,  =  [g^Ii.p  +  pt[h<p  u.  .p 
p  x ' -     -     pp  ± ' '— 


The  primary  objective  is  now  to  show  that 

t [Hpp]l; ; 'transferred  =  ( [HpP] 1; ; } direct 


where,  from  eguation  (3-19) 


([H*  ]i..)t  =  -lGpJ"t( [CP]"1  •   [Hp  ])1..[G 
pp     '  '  <P  <P  <P<P       '  ' 


Pj-1 
cp 


Referring  to  Table  B-l,  one  has  that 

[Gp]  =  [gP!gp!g!] 
cp         —1  ~2  -3 


which  yields 


[G«] 


s9 
-  1 

c9  c9 
i     2  +  3 
a23se3 

rc9 


c9 
 1 

r 

s9  c9 
1  2+3 
a23s9; 


rs9 


G 
s9 


2+3 


a23s93 


(l)pZ 


a23a34s03     a23s34s03  a23a34s03 


where,  s91+2=sin(91  +  92 ) ,  etc.  Applying  the  generalized 
dot  operator  gives 
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([CP]"1   •    [H?  ]),.. 

CD  cpcp         '  ' 


=   ([gP]-1)-,.    •    [HP  ] 
cp  '  cpcp 

=  (gx)T  •  [hp  ] 

P  cpcp 


(B-7) 


=  "  I 

r 


0  U)Pz  a34se2+3 

(Dpz  q  o 

a34s92+3       0  0 


where  [Hw]  is  given  in  Table  B-l.  Finally,  performing  the 
remaining  multiplications  one  has  that 


( c  HS«  j i -  - >  t  =  -i 

pp      '  '  — 

r 


sUe^   -0(28!)  0 
-0(29!)   -3(29!)  0 
0  0  0 

or,  for  the  acceleration  of  joint  one 

s(29x)  -c(29x)  0 

>T 


(B-8) 


)i   =  l[-s9i   c9i   0]P  +     1  PJ 
r  11-—- 


-c(2Q1)     s{2Bl)  0 
0  0  0 


J  (B-9) 


where  recognizing  that 

(1)Pzc92+3  -  r  s92+3  =  -a23s93   ,  r  =  l^Px 

(B-10) 

aids  considerably  in  the  derivation  of  equation  (B-8).  Now, 
from  Fig.  B-l,  one  has  the  two  simple  relationships 


rc9;L  =  Px 
rs9x  =  pV 


(B-ll) 


Taking  the  derivative  of  equation  (B-ll)  with  respect  to 
time  yields 


■rSise!  +  rcQ1  =  Px 
r91c91  +  rs9x  =  £>¥ 


(B-12) 
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which  can  be  solved  to  give 

r  =  Pxcex  +  pYsGi  (B.13) 

and 

r@i  =  -PxsB1  +  ?Yc®1  (B-14) 

Differentiating  equation  (B-14)  with  respect  to  time,  and 
substituting  equation  (B-13)  for  (r)  and  the  solution  of 
equation  (B-14)  for  (8]_)  in  the  resulting  expression  gives 

&l  =  UPYce!  -  ?xsQ±)   +  _2_(Pxce1  +  pYS81)(pYc81  -  BxsQ1) 

r  2 

r  (B-15) 

which  yields  the  same  result  as  that  obtained  using  the 
transfer  of  coordinate  approach  (i.e.,  equation  (B-9), 
thereby  verifying  the  sought  after  relationship  of  equation 
(B-3) . 

For  an  interesting  example  of  the  overall  transfer  of 
coordinate  approach  to  the  modeling  of  wrist-partitioned 
manipulators  see  Rill  (1985).     That  work  deals  (in  essence) 
with  the  dynamic  analysis  of  a  generalized  Stewart  platform 
where  each  leg  (manipulator)  contains  a  spherical  wrist. 
Included  in  the  analysis  is  a  simplified  (specialized)  set 
of  transfer  equations  which  specifically  address 
partitionable  manipulators. 
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Figure  B-l.     Wrist-Partitioned  Manipulator   (First  three  links) 
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Table  B-l.     Kinematic  Influence  Coefficients  for  the  first 


p  =  Sll-3- 


three  links  of  the  Wrist-Partitioned  Manipulator 
34 


+  a23a23  + 


a34a" 


n 

sn 

Rn 

(P-Rn) 

gp 

n 

HP  = 
"~in 

HP 

ni 

1 

s1 

3  lis1 

a23*23  +  a34.a34 

s1 

X  (P-R1) 

s1  X 

*l 

2 

s2 

sill1 

a23§23  +  a34a34 

_3.2 

X  (P-R2) 

S1  X 

3 

§3 

Slis1  +  a23a23 

a34a34 

s3 

x  (P-R3) 

S1  X 

D 

93 

[GP]  = 


LHP   ]•,.  . 
(pep      '  ' 


_rsQl     -JIJp^cQ!  -(a34se2+3)c81" 

rce1    -ii;pzse1  -(a34se2+3)se1 

0  r  a34c02+3 


-rcG- 


ll)pZs0i  (a34se2+3)se1" 
n;pzse1  -rc61  -(a34ce2+3 }c91 

( a34s02+3 ) sQ1  - ( a34c92+3 )c91  - ( a34ce2+3 ) cQ1 


[Hp  ]2.. 
epep  ^  '  ' 


-rs9i  -(DpZcSi  -(a34se2+3)ce1" 

_iijpzc@1  -rs91  -(a34ce2+3 )s®1 

(  a34se2+3  )cQ1  -(a34ce2+3  )s91  -  ( a34c92+3  )  sS-l 


[HP  ]3..  = 
epep  J  '  ' 


APPENDIX  C 


SINGLE-LOOP  PLANAR  FIVE-BAR  ANALYSIS 

The  analytic  example  presented  here  is  given  as  a 
partial  verification  of  the  loop-closure  technique  developed 
in  the  first  section  of  Chapter  IV.     The  well  established 
(Curtis,  1972  and  Freeman,  1980)  dyad-based  linkage  analysis 
procedure  is  employed  for  comparison.     Consider  the  five-bar 
linkage  of  Fig.  C-l. 

The  results  of  the  dyad-based  analysis  are  given  in 
Table  C-l.     This  analysis  is  a  direct  procedure  and  is 
summarized  as  follows 

1.  Kinematics  of  dyad  poles  (i.e.,  A(t)  and  B(t)) 
determined  from  specified  input  kinematics 
(cpx(t)  and  8h(t)  ) . 

2.  Kinematics  of  mass  parameters  (X^(t),  Y^(t), 

2(t))  determined  using  pole  kinematics. 

3.  Pin- joint  reaction  forces  (FA,  FB,  FCJ 
due  to  d'Alembert  loads  determined. 

4.  Required  driving  torques  (T^)  and  (Th)  and  reaction 
forces  (FA)  and  (FB). 

Now,  following  the  transfer  procedure  presented  in 

Chapter  IV.  one  first  obtains  the  open-chain  model 

coefficients 

Sq,  =  [GeJ,[He  ],[P*     ]  fc 

^  cp         (pep         epep         (pepep  ^  x' 

in  the  manner  prescribed  in  Chapter  II,  where 

e  =  (Xh,Yh,9h)T  (C-2) 
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and 


cp  =  (cpj_  ,cp2  ,CP3  ,cp4  ) 


(C-3) 


and  the  resultant  coefficients  are  given  in  Table  C-2. 
Next,  the  augmented  intermediate  coordinate  set  w  is  chosen 
to  be 


w  = 


a  =  (0]_ 


(C-4) 


yielding  the  corresopnding  influence  coefficients  ( [G^j )  and 
(tHqxpJ)  given  in  Table  C-2.     Finally,  using  the  transfer 
equations  one  obtains 


/Tl\ 


?hx 


phy 

w 


=  [I     ]w  +  wx[P  Jw 
WW  ~       —       www  ~ 


(C-5) 


as  the  generalized  load  state  at  the  coordinates  (w) ,  where 


[I*  ]  =  [GwrT[I*  KG*]"1 
ww  cp  (pep  cp 


(C-6) 


and 


[P*     ]  =  [GW]"T{( [GWJ"T  •  [P*     ])  -  ([I*  ]  .  [Hw  ])}[GWJ"1 
www  cp  cp  epepep  ww  epep  cp 

(C-7) 

The  results  of  equations  (C-5),   (C-6)  and  (C-7)  are  given  in 
Table  C-3.     Comparison  of  these  results  with  those  of  the 
direct  dyad-based  analysis  confirm  the  validity  of  the 
transfer  approach. 
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Figure  C-l.     Planar  Five-Bar  Mechanism 
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Table  C-l.     Dyad-based  Analysis 


u 


Y 


1 


r2 


Position  Velocity  Acceleration 

u  (in.,  rad. )     u  (in/s,  rad/s)   (u(in/s2,  rad/s2 


qi               _1k  2.0  1.0 
18 

xA              4.10  -22.55  -27.69 

yA            11.28  8.21  -41.0 

q2              In  3.0  0.5 

2 

xB            33.9  -36.0  -6.0 


B  -3.29  0.0  -108.0 


_7n  -0.074  -3.405 

36 


x2  13.93  --  -4.31 


18.16  --  -74.51 


(FAXf  FAY}  =  (-0.009,  -0.24)lbf  T1  =  0.05  in-lbf 
(FBX;   FBY)   =   (0.07,  -0.15)lbf 

(FHX,  FHY)  =  (O.07,  -0.15)lbf 
T2=  0.83  in-lbf 
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Table  C-2.     Open-chain  Model  Parameters 
10  0  0 


[Gw] 


[GeJ 
CP 


10  0  0 

8.71"  19.98"  33.75"  12" 
33.91"  29.80"  10.14"  0" 
1111 


[Hw   }1. .    =    r0i  [HW   ]4. .    =    [He    ]3. .    =  [0] 

(pep  x '  '        1  u  1  L  "epep     '  '  (pep  J  '  ' 


LH--  j2.. 
epep  ^  '  ' 


. .  =  [He  : 
(pep 


1;; 


33.91  29.80  10.14  0 

29.80  29.80  10.14  0 

10.14  10.14  10.14  0 

0  0  0  0 


(in.  ) 


[Hw  ]3.. 
(p(p  J  '  ' 


[He  ]2.. 
(p(p     ^  '  ' 


8.71  19.98  33.75  12.0 

19.98  19.98  33.75  12.0 

33.75  33.75  33.75  12.0 

12.0  12.0  12.0  12.0 


(in.  ) 


[I     ]  = 
qxp 


2.774  1.418  0  0 

1.418  0.808  0  0 

0  0  0  0 

0  0  0  0 


(in-lbf-s2) 


[P  li.. 
<p(p(p     '  ' 


0  0.428 
0.428  0.428 


0 
0 


0 
0 


0 
0 
0 
0 


(in-ibf-s2) 


[P  ■  b 
cp<p 


[P5 


2  •  • 


0.428 

0 

0 

0 

0 

0 

0 

0 

(in 

0 

0 

0 

0 

0 

0 

0 

0 

[P' 


]3„  =  CO] 

U;;  =  CO] 


in-lbf -s 


-«2 


164 


Table  C-3.     Constrained  System  Model 


[I*  J 

WW 


<?1 
0 

0 

32 


+   (qi    0  0  q2)  [P* 
x  6  www 


[I   ]  = 

WW 


411.24  -5.73  12.29  68.79 

-5.73  0.26  -0.55  -3.10 

12.29  -0.55  1.19  6.64 

68.79  -3.10  6.64  37.17 


[P  = 


www 


31 

50. 

77 

X 

0 

68. 

83 

X 

0 

-147. 

60 

X 

<32 

-825. 

92 

X 

x  10' 


303.35  -0.18  -8.96  2.15 

-0.18  -0.24  -0.61  2.84 

-8.96  -0.61  0.52  7.27 

2.15  2.84  7.27  -181.56 


x  10 


-3 


10~Jin-lbf 
10~3lb* 


'in-lbn 


WWW    4 ' ' 


LP  ]3.. 

WWW      '  ' 


3.38  0.13     0.14  -1.58 

0.13  0.02     0.01  -0.20 

0.14  0.01     0.005  0.17 

■1.58  -0.20  -0.17  9.06 


x  10 


-3 


•7.24  -0.28  -0.29  3.38 

■0.28  -0.04  -0.03  0.43 

■0.29  -0.03  -0.01  0.36 

3.38  0.43  0.36  -19.43 


x  10 


-3 


CP  ] 


www 


4  •  • 


•40.50  -1.58  -1.66  18.95" 

-1.58  -0.20  -0.17  2.42  x  10 

-1.66  -0.17  -0.06  2.03 

18.95  2.42  2.03  -108.75 


-3 


APPENDIX  D 


SPECIAL  CASE  SINGLE-LOOP  MECHANISMS 


Consider  the  spatial  slider-crank  mechanism  of  Fig.  D-l. 
This  device  is  considered  a  special  case  in  that  it  is  a 
two-degree  of  freedom  mechanism,  where  one  of  the 
generalized  coordinates  (the  spin  of  the  coupler  link  about 
its  axis,  65)  has  no  effect  on  the  output  (Pz)  motion 
(Sandor,  1984,  Chap.  6).     To  analyze  this  mechanism  (and 
others  like  it)  using  the  unified  approach  of  the  first 
section  of  Chapter  IV,  the  unspecified  (non-actuated) 
coordinate  85  must  be  included  in  all  generalized  coordinate 
sets.     With  this  requirement  noted,  the  analysis  simply 
follows  the  procedure  outlined  in  Fig.  D-l  and  set  forth  in 
Chapter  IV. 

Consider  the  Bricard  mechanism  of  Fig.  D-2.  According 
to  the  Gruebler  criteria,  this  mechanism  should  have  zero 
mobility.  However,  due  to  its  special  geometry,  this  device 
has  one-degree  of  freedom  (Uicker  et  al.,  1964).  The 
existence  of  a  redundant  constraint  produces  this  unexpected 
freedom  and  manifests  itself  in  the  linear  dependence  of  the 
screw' associated  with  (or  motion  afforded  by)   joint  6  on 
joints  1  through  5.     This  means  that  the  Jacobian  ([G^j) 
relating  the  motion  of  the  hypothetical  end-effector  (u)  to 
the  initial  open-chain  generalized  coordinates  (eg)  is  of 
rank  5  and,  thus,  singular.     In  terms  of  the  algebra,  this 
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singularity  is  essential  in  that  it  implies  the  existence  of 
at  least  one  linearly  independent  non-trivial  solution  to 
the  equation  (see  Fig.  D-2  for  notation) 

e  =  0  =  [iG®]!©  (D-l ) 

Now,  from  the  algebra,  since  the  Jacobian  is  of  dimension  6 
and  rank  5,  there  exists  exactly  one  linearly  independent 
solution  associated  with  the  one  generalized  coordinate 
required  to  specify  the  motion  of  this  mechanism. 
Therefore,  equation  (D-l)  can  be  solved  yielding 

[2GJ]  =  -(^}lt2t3fAt5.lf2t3r4f5)-l[G^lt2f3f,i5.6  =  5x1 

(D-2) 

for  the  first-order  influence  coefficients  relating  the 
initial  coordinates  (2®)  to  the  intermediate  generalized 
coordinate  (y).     Having  obtained  these  constraining 
relationships  (equation  (D-2))  one  can  obtain  the  desired 
dynamic  model  by,  again,  following  the  procedure  of 
Chapter  IV.     The  reader  is  referred  to  Fig.  D-2  for  the 
basic  outline  of  this  analysis.     It  should  be  noted  that  the 
analysis  of  this  mechanism  is  problematically  similar  to 
having  a  singular  manipulator  configuration,  yet  still  being 
able  to  attain  the  specified  end-effector  motion  (i.e.,  the 
specified  motion  space  is  spanned  by  the  linearly 
independent  columns  of  the  Jacobian).     However,  here  the 
column  dependency  is  predetermined  and  the  specified  motion 
(rotation  by  cp6  about  s6 )  is  known  to  be  allowable. 
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Unfortunately,  this  is  not  the  case  in  general  manipulator 
motion. 
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1.  eg  =(81,92, . . . ,07)  + 

|  Transfer 

2.  y  =(©K,X   ,Y   ,Z   ,0   ,0   ,0   ) T  -»■  S 
L        5     p'   p'   p'   x     y'   z  y 

I  Constrain 

3.  w  =(0C,Z  )T  ■+  S 
—        5     p  w 

|  Transfer 

4.  q  =(0ir05)T  -  S 


Figure  D-l.     Spatial  slider-crank  mechanism 
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3.  Determine    [  G^,]    from  equation  (D-2) 

2  <P 

and   [  Hyy]    from  equation  (3-19) 

4.  Obtain  intermediate  model 

S     =   [I*   ] , [P*     ] ,T 

y        yy      yyy  '-y 


Figure  D-2.     The  Bricard  mechanism 


APPENDIX  E 


PARALLEL  MECHANISM  MODELING 


Consider  the  three-degree  of  freedom  parallel-input 
planar  robotic  mechanism  of  Fig.  E-l.     The  goal  of  this 
analysis  is  to  verify  the  overall  modeling  procedure 
presented  in  the  second  section  of  Chapter  IV,  particularly 
the  distribution  of  the  system  mass  parameters.  To 
accomplish  this,  the  system  is  specified  such  that  the 
desired  model  coefficients  are  directly  available,  the 
transfer  procedure  is  then  applied  and  the  results  obtained 
are  compared  with  the  known  (directly  obtrained)  coefficient 
values . 

The  desired  input  locations  (q)  are  specified  to  be  the 
base  joints  of  the  three  branches 

i  =  (l^l'  2*1 '  3«)1)T 

(E-l) 

Now,  in  order  to  have  direct  knowledge  of  the  desired  model 
only  the  base  links  themselves  can  have  mass.     Refering  to 
the  specifications  given  in  Fig.  E-l,  the  effective  inertia 
matrix  referenced  to  the  desired  coordinates  (q)  is 


U  ] 

qg 


100 
020 

0  0  3 


=  constant 

(E-2) 


and  the  velocity  related  coefficient  ([P*qq])is  identically 
zero  (i.e.,  each  actuator  is  solely  responsible  for  its  own 
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mass).     With  the  final  (desired)  model  known,  the  transfer 
technique  is  now  applied  to  verify  its  accuracy.  First, 
following  the  analyses  of  Chapter  II,  the  (independently 
treated)  joint  referenced  model  for  each  leg  is  obtained 

<rS<p)  =  [rG^j,[rHw  ],   [rI*   j   ,  r  =  1,2,3 

(E-3) 

The  results  of  equation  (E-3)  for  branch  one  (i.e.,  r  =  1) 
are  given  in  Table  E-l.     Then,  applying  the  transfer 
equations  (4-43),   (4-44),   (4-45)  and  (4-46),  the  system 
model  referenced  to  the  intermediate  generalized  coordinates 
(w)  is  determined,  yielding  (see  Table  E-l) 

(Sw)  =  [rG<f>],[rH<P  ],[*!*  J,[rp*  ] 
W  WW  WW  www 

(E-4) 

Next,  the  effects  of  each  leg  are  combined  and  the  influence 
coefficients  relating  desired  coordinates  (q)  to  the 
intermediate  coordinates  (w)  are  formed,  giving  (see  Table 
E-2) 


[I*    J   =     E   [rI*  ] 
ww        r=l  ww 


[P      J  =    E  [^p*  j 
www        r=l  www' 


(E-5) 


and 


LG<3]  = 
w 


w  ■L 

[2G<P]i 
w  x 

[3G<P]i 


(E-6) 
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LH<3   j  = 

WW 


l1^  ]l. 

WW  ' 
WW    x  ' 

[3H«>  3i. 


Finally,  applying  the  transfer  equations  once  more,  the 
expected  desired  model 


[I*   3   -   [G<5j-T[i*   HQ*]-1  = 
qq  w  ww  w 


10  0 
0  2  0 
0  0  3 


(E-7) 


[p*     3  =  [G<3j-T{([Gq]-T  .   [P*     ])   _  ]   .   [Hq  ])}[Gq]-l 

qqq        w  w  www  ww        ww  w 

=  [0] 


is  obtained,  verifying  the  transfer  technique, 
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Figure  E-l.     Three-DOF  Planar  Robotic  Mechanism 
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Table  E-l.     Joint-  and  Hand-Referenced  Models  (r=l) 


[lGw]  = 


-1.475     0  -0.5 
2.55     2.28  0.866 
111 


£ihW  h- 


[XHW  J2. 

^   (p(p   ^ ' 


(in.  ) 
(in.  ) 


-2.55  -2.28  -0.866 
-2.28  -2.28  -0.866 
-0.866  -0.866  -0.866 


-1.475  0  -0.5 
0  0  -0.5 

-0.5  -0.5  -0.5 


(in.  ) 


ClI     ]  = 
epep 


10  0 
0  0  0 
0     0  0 


(in-lbfs2) 


(in)     [iHw  ]3. .  =  [0] 

x   <p(p    J  '  ' 


[]P       1  =  [0] 
epepep 


[1G<P]  = 


■0.637     0.225  -0.513 
0.758     0.439  -0.001 
■0.122  -0.664  1.514 


(in.-l) 
(in.-1)  [ 


WW 


]  = 


0.405  -0.143  0.327 
-0.143  0.051-0.116 
0.327  -0.116  0.264 


ww  x '  ' 


0.050  -0.105  0.116 
•0.105  -0.439  0.328 
0.116    .0.328  -0.665 


ClH«>   ]2..  = 

WW      '  ' 


(in 


-1 


CiP  J 


www 


1;; 


0.358  -0.053  0.225 
■0.053     0.419  -0.390 
0.225  -0.390  1.327 


•P  J2.. 

WWW    ^ ' ' 


-0.032     0.067  -0.074 
0.067     0.280  -0.209 
-0.074  -0.209  0.423 


in. "1 J 


0.011  -0.024  -0.026 
-0.024  -0.099  0.074 
0.026     0.074  -0.150 


t1^  ] 


ww 


3;; 


■0.408  0.158  -0.341 
0.158  0.019  0.062 
■0.341  0.062  -0.662 


[!P 


)3.. 
WWW    J ' ' 


-0.026     0.054  -0.059 
0.054     0.225  -0.168 
-0.059  -0.168  0.341 
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Table  E-2.     Complete  Hand-Referenced  Model 


[G<I]  = 
w 


■0.637  0.225  -0.513 
0.124  -0.665  -0.514 
0.513     0.439  -0.513 


(in."1) 


( in. 


-1)  [I* 


WW 


1  = 


[H<3] 


WW 


1  •  • 


[H<3  ] 


WW 


2  •  • 


0.050  -0.105  0.116 
■0.159  -0.439  0.326 
0.116     0.326  -0.665 


(in 


-1 


CP 


■0.408  -0.159  -0.342 
■0.159  0.018  -0.633 
■0.342  -0.633  -0.665 


WWW    x ' ' 


(in.-1) 


WWW    ^ ' ' 


lH<2  ]3..  = 

WW      '  ' 


■0.225  0.263  0.225 
0.263  -0.165  -0.263 
0.225  -0.263  -0.664 


[P! 


www 


J  3  .  . 


1.225     0.367  -0.589 
0.367     1.513  -0.106 
■0.589  -0.106  1.582 


-0.479  0.432  0.188 
0.432  0.031  -0.629 
0.188  -0.629  -0.762 


0.259 
0.534 
0.777 


0.534 
■0.340 
■0.188 


0.777 
■0.188 
•0.137 


0.741  -0.188  -0.054 
-0.188  0.459  0.302 
-0.054     0.302  2.045 


Units  for  [I  ]  and  [P*     ]  include:     (in-lb*-s2)  -  I* 
ww             www                                 t       '  33 

(lbf-s2)  -  I* 
r  13 

( lbf-S2/in. )  -  I* 
r  11 
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